Add uboot net
This commit is contained in:
parent
2081f50307
commit
c86c39abef
4 changed files with 198 additions and 7 deletions
|
@ -1830,6 +1830,12 @@ module = {
|
||||||
enable = ieee1275;
|
enable = ieee1275;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
module = {
|
||||||
|
name = ubootnet;
|
||||||
|
common = net/drivers/uboot/ubootnet.c;
|
||||||
|
enable = uboot;
|
||||||
|
};
|
||||||
|
|
||||||
module = {
|
module = {
|
||||||
name = efinet;
|
name = efinet;
|
||||||
common = net/drivers/efi/efinet.c;
|
common = net/drivers/efi/efinet.c;
|
||||||
|
|
|
@ -82,7 +82,7 @@ grub_uboot_probe_hardware (void)
|
||||||
}
|
}
|
||||||
else if (devinfo->type & DEV_TYP_NET)
|
else if (devinfo->type & DEV_TYP_NET)
|
||||||
{
|
{
|
||||||
grub_dprintf ("init", " type\t\t= NET (not supported yet)\n");
|
grub_dprintf ("init", " type\t\t= NET\n");
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
|
|
185
grub-core/net/drivers/uboot/ubootnet.c
Normal file
185
grub-core/net/drivers/uboot/ubootnet.c
Normal file
|
@ -0,0 +1,185 @@
|
||||||
|
/*
|
||||||
|
* GRUB -- GRand Unified Bootloader
|
||||||
|
* Copyright (C) 2013 Free Software Foundation, Inc.
|
||||||
|
*
|
||||||
|
* GRUB is free software: you can redistribute it and/or modify
|
||||||
|
* it under the terms of the GNU General Public License as published by
|
||||||
|
* the Free Software Foundation, either version 3 of the License, or
|
||||||
|
* (at your option) any later version.
|
||||||
|
*
|
||||||
|
* GRUB is distributed in the hope that it will be useful,
|
||||||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||||
|
* GNU General Public License for more details.
|
||||||
|
*
|
||||||
|
* You should have received a copy of the GNU General Public License
|
||||||
|
* along with GRUB. If not, see <http://www.gnu.org/licenses/>.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <grub/net/netbuff.h>
|
||||||
|
#include <grub/uboot/disk.h>
|
||||||
|
#include <grub/uboot/uboot.h>
|
||||||
|
#include <grub/dl.h>
|
||||||
|
#include <grub/net.h>
|
||||||
|
#include <grub/time.h>
|
||||||
|
#include <grub/i18n.h>
|
||||||
|
|
||||||
|
GRUB_MOD_LICENSE ("GPLv3+");
|
||||||
|
|
||||||
|
struct ubootnet_data
|
||||||
|
{
|
||||||
|
void *cookie;
|
||||||
|
int handle;
|
||||||
|
};
|
||||||
|
|
||||||
|
static grub_err_t
|
||||||
|
card_open (struct grub_net_card *dev)
|
||||||
|
{
|
||||||
|
int status;
|
||||||
|
struct ubootnet_data *data = dev->data;
|
||||||
|
|
||||||
|
status = uboot_dev_open (data->handle);
|
||||||
|
if (status)
|
||||||
|
return grub_error (GRUB_ERR_IO, "Couldn't open network card.");
|
||||||
|
|
||||||
|
return GRUB_ERR_NONE;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
card_close (struct grub_net_card *dev)
|
||||||
|
{
|
||||||
|
struct ubootnet_data *data = dev->data;
|
||||||
|
|
||||||
|
uboot_dev_close (data->handle);
|
||||||
|
}
|
||||||
|
|
||||||
|
static grub_err_t
|
||||||
|
send_card_buffer (struct grub_net_card *dev, struct grub_net_buff *pack)
|
||||||
|
{
|
||||||
|
int status;
|
||||||
|
struct ubootnet_data *data = dev->data;
|
||||||
|
grub_size_t len;
|
||||||
|
|
||||||
|
len = (pack->tail - pack->data);
|
||||||
|
if (len > dev->mtu)
|
||||||
|
len = dev->mtu;
|
||||||
|
|
||||||
|
grub_memcpy (dev->txbuf, pack->data, len);
|
||||||
|
status = uboot_dev_send (data->handle, dev->txbuf,
|
||||||
|
len);
|
||||||
|
|
||||||
|
if (status)
|
||||||
|
return grub_error (GRUB_ERR_IO, N_("couldn't send network packet"));
|
||||||
|
return GRUB_ERR_NONE;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct grub_net_buff *
|
||||||
|
get_card_packet (struct grub_net_card *dev)
|
||||||
|
{
|
||||||
|
int rc;
|
||||||
|
struct ubootnet_data *data = dev->data;
|
||||||
|
grub_uint64_t start_time;
|
||||||
|
struct grub_net_buff *nb;
|
||||||
|
int actual;
|
||||||
|
|
||||||
|
nb = grub_netbuff_alloc (dev->mtu + 64 + 2);
|
||||||
|
if (!nb)
|
||||||
|
{
|
||||||
|
grub_netbuff_free (nb);
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
/* Reserve 2 bytes so that 2 + 14/18 bytes of ethernet header is divisible
|
||||||
|
by 4. So that IP header is aligned on 4 bytes. */
|
||||||
|
grub_netbuff_reserve (nb, 2);
|
||||||
|
|
||||||
|
start_time = grub_get_time_ms ();
|
||||||
|
do
|
||||||
|
{
|
||||||
|
rc = uboot_dev_recv (data->handle, nb->data, dev->mtu + 64, &actual);
|
||||||
|
grub_dprintf ("net", "rc=%d, actual=%d, time=%lld\n", rc, actual,
|
||||||
|
grub_get_time_ms () - start_time);
|
||||||
|
}
|
||||||
|
while ((actual <= 0 || rc < 0) && (grub_get_time_ms () - start_time < 200));
|
||||||
|
if (actual > 0)
|
||||||
|
{
|
||||||
|
grub_netbuff_put (nb, actual);
|
||||||
|
return nb;
|
||||||
|
}
|
||||||
|
grub_netbuff_free (nb);
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct grub_net_card_driver ubootnet =
|
||||||
|
{
|
||||||
|
.name = "ubnet",
|
||||||
|
.open = card_open,
|
||||||
|
.close = card_close,
|
||||||
|
.send = send_card_buffer,
|
||||||
|
.recv = get_card_packet
|
||||||
|
};
|
||||||
|
|
||||||
|
GRUB_MOD_INIT (ubootnet)
|
||||||
|
{
|
||||||
|
int devcount, i;
|
||||||
|
int nfound = 0;
|
||||||
|
|
||||||
|
devcount = uboot_dev_enum ();
|
||||||
|
|
||||||
|
for (i = 0; i < devcount; i++)
|
||||||
|
{
|
||||||
|
struct device_info *devinfo = uboot_dev_get (i);
|
||||||
|
struct ubootnet_data *ubdata;
|
||||||
|
struct grub_net_card *card;
|
||||||
|
|
||||||
|
if (!(devinfo->type & DEV_TYP_NET))
|
||||||
|
continue;
|
||||||
|
|
||||||
|
ubdata = grub_malloc (sizeof (struct ubootnet_data));
|
||||||
|
if (!ubdata)
|
||||||
|
{
|
||||||
|
grub_print_error ();
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
card = grub_zalloc (sizeof (struct grub_net_card));
|
||||||
|
if (!card)
|
||||||
|
{
|
||||||
|
grub_free (ubdata);
|
||||||
|
grub_print_error ();
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
ubdata->handle = i;
|
||||||
|
ubdata->cookie = devinfo->cookie;
|
||||||
|
|
||||||
|
/* FIXME: Any way to check this? */
|
||||||
|
card->mtu = 1500;
|
||||||
|
|
||||||
|
grub_memcpy (&(card->default_address.mac), &devinfo->di_net.hwaddr, 6);
|
||||||
|
card->default_address.type = GRUB_NET_LINK_LEVEL_PROTOCOL_ETHERNET;
|
||||||
|
|
||||||
|
card->txbufsize = ALIGN_UP (card->mtu, 64) + 256;
|
||||||
|
card->txbuf = grub_zalloc (card->txbufsize);
|
||||||
|
if (!card->txbuf)
|
||||||
|
{
|
||||||
|
grub_print_error ();
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
card->data = ubdata;
|
||||||
|
card->flags = 0;
|
||||||
|
card->name = grub_xasprintf ("ubnet_%d", ++nfound);
|
||||||
|
card->idle_poll_delay_ms = 10;
|
||||||
|
|
||||||
|
card->driver = &ubootnet;
|
||||||
|
grub_net_card_register (card);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
GRUB_MOD_FINI (ubootnet)
|
||||||
|
{
|
||||||
|
struct grub_net_card *card, *next;
|
||||||
|
|
||||||
|
FOR_NET_CARDS_SAFE (card, next)
|
||||||
|
if (card->driver && grub_strcmp (card->driver->name, "ubnet") == 0)
|
||||||
|
grub_net_card_unregister (card);
|
||||||
|
}
|
|
@ -100,19 +100,19 @@ grub_uint32_t uboot_get_timer (grub_uint32_t base);
|
||||||
/*
|
/*
|
||||||
* int API_dev_enum(struct device_info *)
|
* int API_dev_enum(struct device_info *)
|
||||||
*/
|
*/
|
||||||
int uboot_dev_enum (void);
|
int EXPORT_FUNC(uboot_dev_enum) (void);
|
||||||
|
|
||||||
struct device_info *uboot_dev_get (int handle);
|
struct device_info *EXPORT_FUNC(uboot_dev_get) (int handle);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* int API_dev_open(struct device_info *)
|
* int API_dev_open(struct device_info *)
|
||||||
*/
|
*/
|
||||||
int uboot_dev_open (int handle);
|
int EXPORT_FUNC(uboot_dev_open) (int handle);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* int API_dev_close(struct device_info *)
|
* int API_dev_close(struct device_info *)
|
||||||
*/
|
*/
|
||||||
int uboot_dev_close (int handle);
|
int EXPORT_FUNC(uboot_dev_close) (int handle);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Notice: this is for sending network packets only, as U-Boot does not
|
* Notice: this is for sending network packets only, as U-Boot does not
|
||||||
|
@ -134,8 +134,8 @@ int uboot_dev_write (int handle, void *buf, int *len);
|
||||||
int uboot_dev_read (int handle, void *buf, lbasize_t blocks,
|
int uboot_dev_read (int handle, void *buf, lbasize_t blocks,
|
||||||
lbastart_t start, lbasize_t * real_blocks);
|
lbastart_t start, lbasize_t * real_blocks);
|
||||||
|
|
||||||
int uboot_dev_recv (int handle, void *buf, int size, int *real_size);
|
int EXPORT_FUNC(uboot_dev_recv) (int handle, void *buf, int size, int *real_size);
|
||||||
int uboot_dev_send (int handle, void *buf, int size);
|
int EXPORT_FUNC(uboot_dev_send) (int handle, void *buf, int size);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* int API_env_get(const char *name, char **value)
|
* int API_env_get(const char *name, char **value)
|
||||||
|
|
Loading…
Reference in a new issue