}
grub_err_t
-grub_net_send_ip_packet (struct grub_net_network_level_interface *inf,
- const grub_net_network_level_address_t *target,
- struct grub_net_buff *nb)
+grub_net_send_ip_packet (struct grub_net_network_level_interface * inf,
+ const grub_net_network_level_address_t * target,
+ struct grub_net_buff * nb)
{
struct iphdr *iph;
static int id = 0x2400;
err = grub_net_arp_resolve (inf, target, &ll_target_addr);
if (err)
return err;
- return send_ethernet_packet (inf, nb, ll_target_addr, GRUB_NET_ETHERTYPE_IP);
+ return send_ethernet_packet (inf, nb, ll_target_addr,
+ GRUB_NET_ETHERTYPE_IP);
}
-/*
-static int
-ip_filter (struct grub_net_buff *nb)
+grub_err_t
+grub_net_recv_ip_packets (struct grub_net_buff * nb,
+ const struct grub_net_card * card,
+ const grub_net_link_level_address_t * hwaddress)
{
struct iphdr *iph = (struct iphdr *) nb->data;
grub_err_t err;
+ struct grub_net_network_level_interface *inf;
- if (nb->end - nb->data < (signed) sizeof (*iph))
- return 0;
-
- if (iph->protocol != 0x11 ||
- iph->dest != inf->address.ipv4)
- return 0;
-
- grub_netbuff_pull (nb, sizeof (iph));
- err = grub_net_put_packet (&inf->nl_pending, nb);
+ err = grub_netbuff_pull (nb, sizeof (*iph));
if (err)
+ return err;
+
+ FOR_NET_NETWORK_LEVEL_INTERFACES (inf)
+ {
+ if (inf->card == card
+ && inf->address.type == GRUB_NET_NETWORK_LEVEL_PROTOCOL_IPV4
+ && inf->address.ipv4 == iph->dest
+ && grub_net_hwaddr_cmp (&inf->hwaddress, hwaddress) == 0)
+ break;
+ }
+ if (!inf)
{
- grub_print_error ();
- return 0;
+ FOR_NET_NETWORK_LEVEL_INTERFACES (inf)
+ if (inf->card == card
+ && inf->address.type == GRUB_NET_NETWORK_LEVEL_PROTOCOL_PROMISC
+ && grub_net_hwaddr_cmp (&inf->hwaddress, hwaddress) == 0)
+ break;
+ }
+ if (!inf)
+ {
+ if (iph->protocol == IP_UDP
+ && grub_net_hwaddr_cmp (&card->default_address, hwaddress) == 0)
+ {
+ struct udphdr *udph;
+ udph = (struct udphdr *) nb->data;
+ grub_netbuff_pull (nb, sizeof (*udph));
+ if (grub_be_to_cpu16 (udph->dst) == 68)
+ grub_net_process_dhcp (nb, card);
+ }
+ grub_netbuff_free (nb);
+ return GRUB_ERR_NONE;
}
- return 1;
-}
-*/
-grub_err_t
-grub_net_recv_ip_packets (struct grub_net_buff *nb)
-{
- struct iphdr *iph = (struct iphdr *) nb->data;
- grub_netbuff_pull (nb, sizeof (*iph));
switch (iph->protocol)
{
case IP_UDP:
- return grub_net_recv_udp_packet (nb);
+ return grub_net_recv_udp_packet (nb, inf);
break;
default:
grub_netbuff_free (nb);
* along with GRUB. If not, see <http://www.gnu.org/licenses/>.
*/
+#include <grub/net/udp.h>
#include <grub/net.h>
#include <grub/net/netbuff.h>
#include <grub/time.h>
#include <grub/command.h>
#include <grub/env.h>
#include <grub/net/ethernet.h>
+#include <grub/datetime.h>
GRUB_MOD_LICENSE ("GPLv3+");
static inline void
grub_net_network_level_interface_unregister (struct grub_net_network_level_interface *inter)
{
- grub_list_remove (GRUB_AS_LIST_P (&grub_net_network_level_interfaces),
- GRUB_AS_LIST (inter));
+ *inter->prev = inter->next;
+ if (inter->next)
+ inter->next->prev = inter->prev;
+ inter->next = 0;
+ inter->prev = 0;
}
static inline void
return 0;
switch (net->type)
{
+ case GRUB_NET_NETWORK_LEVEL_PROTOCOL_PROMISC:
+ return 0;
case GRUB_NET_NETWORK_LEVEL_PROTOCOL_IPV4:
{
grub_int32_t mask = ((1 << net->ipv4.masksize) - 1) << (32 - net->ipv4.masksize);
{
switch (target->type)
{
+ case GRUB_NET_NETWORK_LEVEL_PROTOCOL_PROMISC:
+ grub_strcpy (buf, "promisc");
+ return;
case GRUB_NET_NETWORK_LEVEL_PROTOCOL_IPV4:
{
grub_uint32_t n = grub_be_to_cpu32 (target->ipv4);
grub_printf ("Unsupported hw address type %d\n", addr->type);
}
+int
+grub_net_hwaddr_cmp (const grub_net_link_level_address_t *a,
+ const grub_net_link_level_address_t *b)
+{
+ if (a->type < b->type)
+ return -1;
+ if (a->type > b->type)
+ return +1;
+ switch (a->type)
+ {
+ case GRUB_NET_LINK_LEVEL_PROTOCOL_ETHERNET:
+ return grub_memcmp (a->mac, b->mac, sizeof (a->mac));
+ }
+ grub_printf ("Unsupported hw address type %d\n", a->type);
+ return 1;
+}
+
/* FIXME: implement this. */
static char *
hwaddr_set_env (struct grub_env_var *var __attribute__ ((unused)),
grub_register_variable_hook (name, 0, addr_set_env);
}
- grub_list_push (GRUB_AS_LIST_P (&grub_net_network_level_interfaces),
- GRUB_AS_LIST (inter));
+ inter->prev = &grub_net_network_level_interfaces;
+ inter->next = grub_net_network_level_interfaces;
+ if (inter->next)
+ inter->next->prev = &inter->next;
+ grub_net_network_level_interfaces = inter;
}
struct grub_net_network_level_interface *
-grub_net_add_addr (const char *name, struct grub_net_card *card,
+grub_net_add_addr (const char *name,
+ const struct grub_net_card *card,
grub_net_network_level_address_t addr,
grub_net_link_level_address_t hwaddress,
grub_net_interface_flags_t flags)
{
switch (target->type)
{
+ case GRUB_NET_NETWORK_LEVEL_PROTOCOL_PROMISC:
+ grub_printf ("promisc\n");
+ break;
case GRUB_NET_NETWORK_LEVEL_PROTOCOL_IPV4:
{
grub_uint32_t n = grub_be_to_cpu32 (target->ipv4.base);
return GRUB_ERR_NONE;
}
+static grub_err_t
+grub_cmd_listaddrs (struct grub_command *cmd __attribute__ ((unused)),
+ int argc __attribute__ ((unused)),
+ char **args __attribute__ ((unused)))
+{
+ struct grub_net_network_level_interface *inf;
+ FOR_NET_NETWORK_LEVEL_INTERFACES (inf)
+ {
+ char bufh[MAX_STR_HWADDR_LEN];
+ char bufn[GRUB_NET_MAX_STR_ADDR_LEN];
+ hwaddr_to_str (&inf->hwaddress, bufh);
+ grub_net_addr_to_str (&inf->address, bufn);
+ grub_printf ("%s %s %s\n", inf->name, bufh, bufn);
+ }
+ return GRUB_ERR_NONE;
+}
+
grub_net_app_level_t grub_net_app_level_list;
struct grub_net_socket *grub_net_sockets;
static void
receive_packets (struct grub_net_card *card)
{
- /* Maybe should be better have a fixed number of packets for each card
- and just mark them as used and not used. */
- struct grub_net_buff *nb;
- grub_ssize_t actual;
- nb = grub_netbuff_alloc (1500);
- if (!nb)
+ while (1)
{
- grub_print_error ();
- return;
- }
+ /* Maybe should be better have a fixed number of packets for each card
+ and just mark them as used and not used. */
+ struct grub_net_buff *nb;
+ grub_ssize_t actual;
+ nb = grub_netbuff_alloc (1500);
+ if (!nb)
+ {
+ grub_print_error ();
+ return;
+ }
- actual = card->driver->recv (card, nb);
- if (actual < 0)
- grub_netbuff_free (nb);
- else
- grub_net_recv_ethernet_packet (nb);
+ actual = card->driver->recv (card, nb);
+ if (actual < 0)
+ {
+ grub_netbuff_free (nb);
+ break;
+ }
+ grub_net_recv_ethernet_packet (nb, card);
+ }
grub_print_error ();
}
#define OFFSET_OF(x, y) ((grub_uint8_t *)((y)->x) - (grub_uint8_t *)(y))
struct grub_net_network_level_interface *
-grub_net_configure_by_dhcp_ack (const char *name, struct grub_net_card *card,
+grub_net_configure_by_dhcp_ack (const char *name,
+ const struct grub_net_card *card,
grub_net_interface_flags_t flags,
- struct grub_net_bootp_ack *bp,
+ const struct grub_net_bootp_packet *bp,
grub_size_t size)
{
grub_net_network_level_address_t addr;
return inter;
}
+void
+grub_net_process_dhcp (struct grub_net_buff *nb,
+ const struct grub_net_card *card)
+{
+ char *name;
+ struct grub_net_network_level_interface *inf;
+
+ name = grub_xasprintf ("%s:dhcp", card->name);
+ if (!name)
+ {
+ grub_print_error ();
+ return;
+ }
+ grub_net_configure_by_dhcp_ack (name, card,
+ 0, (const struct grub_net_bootp_packet *) nb->data,
+ (nb->tail - nb->data));
+ grub_free (name);
+ if (grub_errno)
+ grub_print_error ();
+ else
+ {
+ FOR_NET_NETWORK_LEVEL_INTERFACES(inf)
+ if (grub_memcmp (inf->name, card->name, grub_strlen (card->name)) == 0
+ && grub_memcmp (inf->name + grub_strlen (card->name),
+ ":dhcp_tmp", sizeof (":dhcp_tmp") - 1) == 0)
+ {
+ grub_net_network_level_interface_unregister (inf);
+ break;
+ }
+ }
+}
+
static char
hexdigit (grub_uint8_t val)
{
"unrecognised format specification %s", args[3]);
}
+static grub_err_t
+grub_cmd_bootp (struct grub_command *cmd __attribute__ ((unused)),
+ int argc, char **args)
+{
+ struct grub_net_card *card;
+ struct grub_net_network_level_interface *ifaces;
+ grub_size_t ncards = 0;
+ unsigned j = 0;
+ int interval;
+ grub_err_t err;
+
+ FOR_NET_CARDS (card)
+ {
+ if (argc > 0 && grub_strcmp (card->name, args[0]) != 0)
+ continue;
+ ncards++;
+ }
+
+ ifaces = grub_zalloc (ncards * sizeof (ifaces[0]));
+ if (!ifaces)
+ return grub_errno;
+
+ j = 0;
+ FOR_NET_CARDS (card)
+ {
+ if (argc > 0 && grub_strcmp (card->name, args[0]) != 0)
+ continue;
+ ifaces[j].card = card;
+ ifaces[j].next = &ifaces[j+1];
+ if (j)
+ ifaces[j].prev = &ifaces[j-1].next;
+ ifaces[j].name = grub_xasprintf ("%s:dhcp_tmp", card->name);
+ if (!ifaces[j].name)
+ {
+ unsigned i;
+ for (i = 0; i < j; i++)
+ grub_free (ifaces[i].name);
+ grub_free (ifaces);
+ return grub_errno;
+ }
+ ifaces[j].address.type = GRUB_NET_NETWORK_LEVEL_PROTOCOL_PROMISC;
+ grub_memcpy (&ifaces[j].hwaddress, &card->default_address,
+ sizeof (ifaces[j].hwaddress));
+ j++;
+ }
+ ifaces[ncards - 1].next = grub_net_network_level_interfaces;
+ if (grub_net_network_level_interfaces)
+ grub_net_network_level_interfaces->prev = & ifaces[ncards - 1].next;
+ grub_net_network_level_interfaces = &ifaces[0];
+ ifaces[0].prev = &grub_net_network_level_interfaces;
+ for (interval = 200; interval < 10000; interval *= 2)
+ {
+ int done = 0;
+ for (j = 0; j < ncards; j++)
+ {
+ struct grub_net_bootp_packet *pack;
+ struct grub_datetime date;
+ grub_int32_t t;
+ struct grub_net_buff *nb;
+ struct udphdr *udph;
+ grub_net_network_level_address_t target;
+
+ if (!ifaces[j].prev)
+ continue;
+ nb = grub_netbuff_alloc (sizeof (*pack));
+ if (!nb)
+ return grub_errno;
+ err = grub_netbuff_reserve (nb, sizeof (*pack) + 64 + 128);
+ if (err)
+ return err;
+ err = grub_netbuff_push (nb, sizeof (*pack) + 64);
+ if (err)
+ return err;
+ pack = (void *) nb->data;
+ done = 1;
+ grub_memset (pack, 0, sizeof (*pack) + 64);
+ pack->opcode = 1;
+ pack->hw_type = 1;
+ pack->hw_len = 6;
+ err = grub_get_datetime (&date);
+ if (err || !grub_datetime2unixtime (&date, &t))
+ {
+ grub_errno = GRUB_ERR_NONE;
+ t = 0;
+ }
+ pack->ident = grub_cpu_to_be32 (t);
+ pack->seconds = 0;//grub_cpu_to_be16 (t);
+
+ grub_memcpy (&pack->mac_addr, &ifaces[j].hwaddress.mac, 6);
+
+ grub_netbuff_push (nb, sizeof (*udph));
+
+ udph = (struct udphdr *) nb->data;
+ udph->src = grub_cpu_to_be16 (68);
+ udph->dst = grub_cpu_to_be16 (67);
+ udph->chksum = 0;
+ udph->len = grub_cpu_to_be16 (nb->tail - nb->data);
+
+ target.type = GRUB_NET_NETWORK_LEVEL_PROTOCOL_IPV4;
+ target.ipv4 = 0xffffffff;
+
+ err = grub_net_send_ip_packet (&ifaces[j], &target, nb);
+ if (err)
+ return err;
+ }
+ if (!done)
+ break;
+ grub_net_poll_cards (interval);
+ }
+
+ err = GRUB_ERR_NONE;
+ for (j = 0; j < ncards; j++)
+ {
+ if (!ifaces[j].prev)
+ continue;
+ grub_error_push ();
+ grub_net_network_level_interface_unregister (&ifaces[j]);
+ err = grub_error (GRUB_ERR_FILE_NOT_FOUND, "couldn't configure %s",
+ ifaces[j].card->name);
+ }
+
+ return err;
+}
+
+
static struct grub_fs grub_net_fs =
{
.name = "netfs",
.mtime = NULL,
};
static grub_command_t cmd_addaddr, cmd_deladdr, cmd_addroute, cmd_delroute;
-static grub_command_t cmd_lsroutes, cmd_lscards, cmd_getdhcp;
+static grub_command_t cmd_lsroutes, cmd_lscards, cmd_getdhcp, cmd_bootp;
+static grub_command_t cmd_dhcp, cmd_lsaddr;
GRUB_MOD_INIT(net)
{
"", N_("list network routes"));
cmd_lscards = grub_register_command ("net_ls_cards", grub_cmd_listcards,
"", N_("list network cards"));
+ cmd_lsaddr = grub_register_command ("net_ls_addr", grub_cmd_listaddrs,
+ "", N_("list network addresses"));
+ cmd_bootp = grub_register_command ("net_bootp", grub_cmd_bootp,
+ "[CARD]",
+ N_("perform a bootp autoconfiguration"));
+ cmd_dhcp = grub_register_command ("net_dhcp", grub_cmd_bootp,
+ "[CARD]",
+ N_("perform a bootp autoconfiguration"));
cmd_getdhcp = grub_register_command ("net_get_dhcp_option", grub_cmd_dhcpopt,
N_("VAR INTERFACE NUMBER DESCRIPTION"),
N_("retrieve DHCP option and save it into VAR. If VAR is - then print the value."));
grub_unregister_command (cmd_delroute);
grub_unregister_command (cmd_lsroutes);
grub_unregister_command (cmd_lscards);
+ grub_unregister_command (cmd_lsaddr);
grub_unregister_command (cmd_getdhcp);
grub_fs_unregister (&grub_net_fs);
grub_net_open = NULL;
char *name;
grub_err_t (*init) (struct grub_net_card *dev);
grub_err_t (*fini) (struct grub_net_card *dev);
- grub_err_t (*send) (struct grub_net_card *dev, struct grub_net_buff *buf);
- grub_ssize_t (*recv) (struct grub_net_card *dev, struct grub_net_buff *buf);
+ grub_err_t (*send) (const struct grub_net_card *dev,
+ struct grub_net_buff *buf);
+ grub_ssize_t (*recv) (const struct grub_net_card *dev,
+ struct grub_net_buff *buf);
};
extern struct grub_net_card_driver *grub_net_card_drivers;
typedef enum grub_network_level_protocol_id
{
+ GRUB_NET_NETWORK_LEVEL_PROTOCOL_PROMISC,
GRUB_NET_NETWORK_LEVEL_PROTOCOL_IPV4
} grub_network_level_protocol_id_t;
struct grub_net_network_level_interface
{
struct grub_net_network_level_interface *next;
+ struct grub_net_network_level_interface **prev;
char *name;
- struct grub_net_card *card;
+ const struct grub_net_card *card;
grub_net_network_level_address_t address;
grub_net_link_level_address_t hwaddress;
grub_net_interface_flags_t flags;
- struct grub_net_bootp_ack *dhcp_ack;
+ struct grub_net_bootp_packet *dhcp_ack;
grub_size_t dhcp_acklen;
void *data;
};
}
struct grub_net_network_level_interface *
-grub_net_add_addr (const char *name, struct grub_net_card *card,
+grub_net_add_addr (const char *name,
+ const struct grub_net_card *card,
grub_net_network_level_address_t addr,
grub_net_link_level_address_t hwaddress,
grub_net_interface_flags_t flags);
typedef grub_uint8_t grub_net_bootp_mac_addr_t[GRUB_NET_BOOTP_MAC_ADDR_LEN];
-struct grub_net_bootp_ack
+struct grub_net_bootp_packet
{
grub_uint8_t opcode;
grub_uint8_t hw_type; /* hardware type. */
#define GRUB_NET_BOOTP_RFC1048_MAGIC 0x63825363L
struct grub_net_network_level_interface *
-grub_net_configure_by_dhcp_ack (const char *name, struct grub_net_card *card,
+grub_net_configure_by_dhcp_ack (const char *name,
+ const struct grub_net_card *card,
grub_net_interface_flags_t flags,
- struct grub_net_bootp_ack *bp,
+ const struct grub_net_bootp_packet *bp,
grub_size_t size);
+void
+grub_net_process_dhcp (struct grub_net_buff *nb,
+ const struct grub_net_card *card);
+
+int
+grub_net_hwaddr_cmp (const grub_net_link_level_address_t *a,
+ const grub_net_link_level_address_t *b);
+
+
/*
Currently suppoerted adresses:
IPv4: XXX.XXX.XXX.XXX
grub_err_t grub_net_recv_link_layer (struct grub_net_network_level_interface *inf,
grub_net_packet_handler_t handler);
-grub_err_t
-grub_net_recv_ip_packets (struct grub_net_buff *nb);
+
+grub_err_t
+grub_net_recv_ip_packets (struct grub_net_buff *nb,
+ const struct grub_net_card *card,
+ const grub_net_link_level_address_t *hwaddress);
grub_err_t
grub_net_send_ip_packet (struct grub_net_network_level_interface *inf,
projects / thirdparty / grub.git / commitdiff
