mirror of
https://git.rtems.org/rtems-libbsd/
synced 2025-06-08 07:22:08 +08:00
Add RTEMS Network Setup Helper
This commit is contained in:
Joel Sherrill
parent
079c3f27ea
commit
e25eda8a0f
261
freebsd-userspace/rtems/rtems-net-setup.c
Normal file
261
freebsd-userspace/rtems/rtems-net-setup.c
Normal file
@ -0,0 +1,261 @@
|
||||
/*
|
||||
* XXX copyright and license.
|
||||
* XXX integrate more setup from old code in rtems_glue.c
|
||||
* XXX integrate using old configuration structure as it makes sense
|
||||
*/
|
||||
|
||||
#include <freebsd/bsd.h>
|
||||
#include <sys/socket.h>
|
||||
#include <net/if.h>
|
||||
#include <netinet/in.h>
|
||||
#include <arpa/inet.h>
|
||||
|
||||
static const struct sockaddr_in address_template = {
|
||||
sizeof(address_template),
|
||||
AF_INET,
|
||||
0,
|
||||
{ INADDR_ANY },
|
||||
{ 0, 0, 0, 0, 0, 0, 0, 0 }
|
||||
};
|
||||
|
||||
static void
|
||||
rtems_bsdnet_initialize_sockaddr_in(struct sockaddr_in *addr)
|
||||
{
|
||||
memcpy(addr, &address_template, sizeof(*addr));
|
||||
}
|
||||
|
||||
/*
|
||||
* Interface Configuration.
|
||||
*/
|
||||
int rtems_bsdnet_ifconfig(const char *ifname, uint32_t cmd, void *param)
|
||||
{
|
||||
int s, r = 0;
|
||||
struct ifreq ifreq;
|
||||
|
||||
/*
|
||||
* Configure interfaces
|
||||
*/
|
||||
s = socket (AF_INET, SOCK_DGRAM, 0);
|
||||
if (s < 0)
|
||||
return -1;
|
||||
|
||||
strncpy (ifreq.ifr_name, ifname, IFNAMSIZ);
|
||||
|
||||
switch (cmd) {
|
||||
case SIOCSIFADDR:
|
||||
case SIOCSIFNETMASK:
|
||||
memcpy (&ifreq.ifr_addr, param, sizeof (struct sockaddr));
|
||||
r = ioctl (s, cmd, &ifreq);
|
||||
break;
|
||||
|
||||
case OSIOCGIFADDR:
|
||||
case SIOCGIFADDR:
|
||||
case OSIOCGIFNETMASK:
|
||||
case SIOCGIFNETMASK:
|
||||
if ((r = ioctl (s, cmd, &ifreq)) < 0)
|
||||
break;
|
||||
memcpy (param, &ifreq.ifr_addr, sizeof (struct sockaddr));
|
||||
break;
|
||||
|
||||
case SIOCGIFFLAGS:
|
||||
case SIOCSIFFLAGS:
|
||||
if ((r = ioctl (s, SIOCGIFFLAGS, &ifreq)) < 0)
|
||||
break;
|
||||
if (cmd == SIOCGIFFLAGS) {
|
||||
*((short*) param) = ifreq.ifr_flags;
|
||||
break;
|
||||
}
|
||||
ifreq.ifr_flags |= *((short*) param);
|
||||
if ( (*((short*) param) & IFF_UP ) == 0 ) {
|
||||
/* set the interface down */
|
||||
ifreq.ifr_flags &= ~(IFF_UP);
|
||||
}
|
||||
r = ioctl (s, SIOCSIFFLAGS, &ifreq);
|
||||
break;
|
||||
|
||||
case SIOCSIFDSTADDR:
|
||||
memcpy (&ifreq.ifr_dstaddr, param, sizeof (struct sockaddr));
|
||||
r = ioctl (s, cmd, &ifreq);
|
||||
break;
|
||||
|
||||
case OSIOCGIFDSTADDR:
|
||||
case SIOCGIFDSTADDR:
|
||||
if ((r = ioctl (s, cmd, &ifreq)) < 0)
|
||||
break;
|
||||
memcpy (param, &ifreq.ifr_dstaddr, sizeof (struct sockaddr));
|
||||
break;
|
||||
|
||||
case SIOCSIFBRDADDR:
|
||||
memcpy (&ifreq.ifr_broadaddr, param, sizeof (struct sockaddr));
|
||||
r = ioctl (s, cmd, &ifreq);
|
||||
break;
|
||||
|
||||
case OSIOCGIFBRDADDR:
|
||||
case SIOCGIFBRDADDR:
|
||||
if ((r = ioctl (s, cmd, &ifreq)) < 0)
|
||||
break;
|
||||
memcpy (param, &ifreq.ifr_broadaddr, sizeof (struct sockaddr));
|
||||
break;
|
||||
|
||||
case SIOCSIFMETRIC:
|
||||
ifreq.ifr_metric = *((int*) param);
|
||||
r = ioctl (s, cmd, &ifreq);
|
||||
break;
|
||||
|
||||
case SIOCGIFMETRIC:
|
||||
if ((r = ioctl (s, cmd, &ifreq)) < 0)
|
||||
break;
|
||||
*((int*) param) = ifreq.ifr_metric;
|
||||
break;
|
||||
|
||||
case SIOCSIFMTU:
|
||||
ifreq.ifr_mtu = *((int*) param);
|
||||
r = ioctl (s, cmd, &ifreq);
|
||||
break;
|
||||
|
||||
case SIOCGIFMTU:
|
||||
if ((r = ioctl (s, cmd, &ifreq)) < 0)
|
||||
break;
|
||||
*((int*) param) = ifreq.ifr_mtu;
|
||||
break;
|
||||
|
||||
case SIOCSIFPHYS:
|
||||
ifreq.ifr_phys = *((int*) param);
|
||||
r = ioctl (s, cmd, &ifreq);
|
||||
break;
|
||||
|
||||
case SIOCGIFPHYS:
|
||||
if ((r = ioctl (s, cmd, &ifreq)) < 0)
|
||||
break;
|
||||
*((int*) param) = ifreq.ifr_phys;
|
||||
break;
|
||||
|
||||
case SIOCSIFMEDIA:
|
||||
ifreq.ifr_media = *((int*) param);
|
||||
r = ioctl (s, cmd, &ifreq);
|
||||
break;
|
||||
|
||||
case SIOCGIFMEDIA:
|
||||
/* 'param' passes the phy index they want to
|
||||
* look at...
|
||||
*/
|
||||
ifreq.ifr_media = *((int*) param);
|
||||
if ((r = ioctl (s, cmd, &ifreq)) < 0)
|
||||
break;
|
||||
*((int*) param) = ifreq.ifr_media;
|
||||
break;
|
||||
|
||||
case SIOCAIFADDR:
|
||||
case SIOCDIFADDR:
|
||||
r = ioctl(s, cmd, (struct ifreq *) param);
|
||||
break;
|
||||
|
||||
default:
|
||||
errno = EOPNOTSUPP;
|
||||
r = -1;
|
||||
break;
|
||||
}
|
||||
|
||||
close (s);
|
||||
return r;
|
||||
}
|
||||
|
||||
|
||||
|
||||
static bool rtems_bsdnet_setup_interface(
|
||||
const char *name,
|
||||
const char *ip_address,
|
||||
const char *ip_netmask
|
||||
)
|
||||
{
|
||||
struct sockaddr_in address;
|
||||
struct sockaddr_in netmask;
|
||||
short flags;
|
||||
|
||||
/*
|
||||
* Bring interface up
|
||||
*/
|
||||
flags = IFF_UP;
|
||||
if (rtems_bsdnet_ifconfig (name, SIOCSIFFLAGS, &flags) < 0) {
|
||||
printf ("Can't bring %s up: %s\n", name, strerror (errno));
|
||||
return false;
|
||||
}
|
||||
|
||||
/*
|
||||
* Set interface netmask
|
||||
*/
|
||||
rtems_bsdnet_initialize_sockaddr_in(&netmask);
|
||||
netmask.sin_addr.s_addr = inet_addr (ip_netmask);
|
||||
if (rtems_bsdnet_ifconfig (name, SIOCSIFNETMASK, &netmask) < 0) {
|
||||
printf ("Can't set %s netmask: %s\n", name, strerror (errno));
|
||||
return false;
|
||||
}
|
||||
|
||||
/*
|
||||
* Set interface address
|
||||
*/
|
||||
rtems_bsdnet_initialize_sockaddr_in(&address);
|
||||
address.sin_addr.s_addr = inet_addr (ip_address);
|
||||
if (rtems_bsdnet_ifconfig (name, SIOCSIFADDR, &address) < 0) {
|
||||
printf ("Can't set %s address: %s\n", name, strerror (errno));
|
||||
return false;
|
||||
}
|
||||
|
||||
/*
|
||||
* Set interface broadcast address if the interface has the
|
||||
* broadcast flag set.
|
||||
*/
|
||||
if (rtems_bsdnet_ifconfig (name, SIOCGIFFLAGS, &flags) < 0) {
|
||||
printf ("Can't read %s flags: %s\n", name, strerror (errno));
|
||||
return false;
|
||||
}
|
||||
|
||||
if (flags & IFF_BROADCAST) {
|
||||
struct sockaddr_in broadcast;
|
||||
|
||||
rtems_bsdnet_initialize_sockaddr_in(&broadcast);
|
||||
broadcast.sin_addr.s_addr =
|
||||
address.sin_addr.s_addr | ~netmask.sin_addr.s_addr;
|
||||
if (rtems_bsdnet_ifconfig (name, SIOCSIFBRDADDR, &broadcast) < 0) {
|
||||
struct in_addr in_addr;
|
||||
char buf[20];
|
||||
in_addr.s_addr = broadcast.sin_addr.s_addr;
|
||||
if (!inet_ntop(AF_INET, &in_addr, buf, sizeof(buf)))
|
||||
strcpy(buf,"?.?.?.?");
|
||||
printf ("Can't set %s broadcast address %s: %s\n",
|
||||
name, buf, strerror (errno));
|
||||
}
|
||||
}
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
|
||||
|
||||
void rtems_initialize_interfaces(void)
|
||||
{
|
||||
bool any_if_configured;
|
||||
|
||||
any_if_configured = false;
|
||||
|
||||
any_if_configured |= rtems_bsdnet_setup_interface(
|
||||
"lo0",
|
||||
"127.0.0.1",
|
||||
"255.0.0.0"
|
||||
);
|
||||
|
||||
#if 0
|
||||
|
||||
for (ifp = rtems_bsdnet_config.ifconfig ; ifp ; ifp = ifp->next) {
|
||||
if (ifp->ip_address == NULL)
|
||||
continue;
|
||||
|
||||
any_if_configured |= rtems_bsdnet_setup_interface(
|
||||
ifp->name,
|
||||
ifp->ip_address,
|
||||
ifp->ip_netmask
|
||||
);
|
||||
}
|
||||
#endif
|
||||
|
||||
}
|
||||
Loading…
x
Reference in New Issue
Block a user