source: rtems-libbsd/freebsd-userspace/rtems/rtems-net-setup.c @ 0d928a0

4.1155-freebsd-126-freebsd-12freebsd-9.3
Last change on this file since 0d928a0 was bd6dd6e, checked in by Joel Sherrill <joel.sherrill@…>, on Jul 27, 2012 at 12:45:06 PM

net-setup: Add routing and old stack's configuration

This allows the old stack's configuration structures to be used
unchanged even though this code currently does not support all
of the options. It likely will never support all of the options
as some should eventually come through configuration files as
they would in a real FreeBSD system. Other configuration
parameters are likely configurable via "hints".

  • Property mode set to 100644
File size: 7.1 KB
Line 
1/*
2 * XXX copyright and license.
3 * XXX integrate more setup from old code in rtems_glue.c
4 * XXX integrate using old configuration structure as it makes sense
5 */
6
7#include <freebsd/bsd.h>
8#include <sys/socket.h>
9#include <net/if.h>
10#include <netinet/in.h>
11#include <arpa/inet.h>
12#include <net/route.h>
13#include <rtems/rtems_bsdnet.h>
14
15static const struct sockaddr_in address_template = {
16  sizeof(address_template),
17  AF_INET,
18  0,
19  { INADDR_ANY },
20  { 0, 0, 0, 0, 0, 0, 0, 0 }
21};
22
23/*
24 * Manipulate routing tables
25 */
26int rtems_bsdnet_rtrequest(
27  int              req,
28  struct sockaddr *dst,
29  struct sockaddr *gateway,
30  struct sockaddr *netmask,
31  int              flags,
32  struct rtentry **net_nrt
33)
34{
35  int error;
36
37  // rtems_bsdnet_semaphore_obtain();
38  error = rtrequest(req, dst, gateway, netmask, flags, net_nrt);
39  // rtems_bsdnet_semaphore_release();
40  if (error) {
41    errno = error;
42    return -1;
43  }
44  return 0;
45}
46
47static void
48rtems_bsdnet_initialize_sockaddr_in(struct sockaddr_in *addr)
49{
50  memcpy(addr, &address_template, sizeof(*addr));
51}
52
53/*
54 * Interface Configuration.
55 */
56int rtems_bsdnet_ifconfig(const char *ifname, uint32_t cmd, void *param)
57{
58  int s, r = 0;
59  struct ifreq ifreq;
60
61  /*
62   * Configure interfaces
63   */
64  s = socket(AF_INET, SOCK_DGRAM, 0);
65  if (s < 0)
66    return -1;
67
68  strncpy(ifreq.ifr_name, ifname, IFNAMSIZ);
69
70  switch (cmd) {
71    case SIOCSIFADDR:
72    case SIOCSIFNETMASK:
73      memcpy(&ifreq.ifr_addr, param, sizeof(struct sockaddr));
74      r = ioctl(s, cmd, &ifreq);
75      break;
76
77    case OSIOCGIFADDR:
78    case SIOCGIFADDR:
79    case OSIOCGIFNETMASK:
80    case SIOCGIFNETMASK:
81      if ((r = ioctl(s, cmd, &ifreq)) < 0)
82        break;
83      memcpy(param, &ifreq.ifr_addr, sizeof(struct sockaddr));
84      break;
85
86    case SIOCGIFFLAGS:
87    case SIOCSIFFLAGS:
88      if ((r = ioctl(s, SIOCGIFFLAGS, &ifreq)) < 0)
89        break;
90      if (cmd == SIOCGIFFLAGS) {
91        *((short*) param) = ifreq.ifr_flags;
92        break;
93      }
94      ifreq.ifr_flags |= *((short*) param);
95      if ( (*((short*) param) & IFF_UP ) == 0 ) {
96          /* set the interface down */
97          ifreq.ifr_flags &= ~(IFF_UP);
98      }
99      r = ioctl(s, SIOCSIFFLAGS, &ifreq);
100      break;
101
102    case SIOCSIFDSTADDR:
103      memcpy(&ifreq.ifr_dstaddr, param, sizeof(struct sockaddr));
104      r = ioctl(s, cmd, &ifreq);
105      break;
106
107    case OSIOCGIFDSTADDR:
108    case SIOCGIFDSTADDR:
109      if ((r = ioctl(s, cmd, &ifreq)) < 0)
110        break;
111      memcpy(param, &ifreq.ifr_dstaddr, sizeof(struct sockaddr));
112      break;
113
114    case SIOCSIFBRDADDR:
115      memcpy(&ifreq.ifr_broadaddr, param, sizeof(struct sockaddr));
116      r = ioctl(s, cmd, &ifreq);
117      break;
118
119    case OSIOCGIFBRDADDR:
120    case SIOCGIFBRDADDR:
121      if ((r = ioctl(s, cmd, &ifreq)) < 0)
122        break;
123      memcpy(param, &ifreq.ifr_broadaddr, sizeof(struct sockaddr));
124      break;
125
126    case SIOCSIFMETRIC:
127      ifreq.ifr_metric = *((int*) param);
128      r = ioctl(s, cmd, &ifreq);
129      break;
130
131    case SIOCGIFMETRIC:
132      if ((r = ioctl(s, cmd, &ifreq)) < 0)
133        break;
134      *((int*) param) = ifreq.ifr_metric;
135      break;
136
137    case SIOCSIFMTU:
138      ifreq.ifr_mtu = *((int*) param);
139      r = ioctl(s, cmd, &ifreq);
140      break;
141
142    case SIOCGIFMTU:
143      if ((r = ioctl(s, cmd, &ifreq)) < 0)
144        break;
145      *((int*) param) = ifreq.ifr_mtu;
146      break;
147
148    case SIOCSIFPHYS:
149      ifreq.ifr_phys = *((int*) param);
150      r = ioctl(s, cmd, &ifreq);
151      break;
152
153    case SIOCGIFPHYS:
154      if ((r = ioctl(s, cmd, &ifreq)) < 0)
155        break;
156      *((int*) param) = ifreq.ifr_phys;
157      break;
158
159    case SIOCSIFMEDIA:
160      ifreq.ifr_media = *((int*) param);
161      r = ioctl(s, cmd, &ifreq);
162      break;
163
164    case SIOCGIFMEDIA:
165      /* 'param' passes the phy index they want to
166       * look at...
167       */
168      ifreq.ifr_media = *((int*) param);
169      if ((r = ioctl(s, cmd, &ifreq)) < 0)
170        break;
171      *((int*) param) = ifreq.ifr_media;
172      break;
173
174    case SIOCAIFADDR:
175    case SIOCDIFADDR:
176      r = ioctl(s, cmd, (struct ifreq *) param);
177      break;
178
179    default:
180      errno = EOPNOTSUPP;
181      r = -1;
182      break;
183  }
184
185  close(s);
186  return r;
187}
188
189
190
191static bool rtems_bsdnet_setup_interface(
192  const char *name,
193  const char *ip_address,
194  const char *ip_netmask
195)
196{
197  struct sockaddr_in address;
198  struct sockaddr_in netmask;
199  short flags;
200
201  /*
202   * Bring interface up
203   */
204  flags = IFF_UP;
205  if (rtems_bsdnet_ifconfig(name, SIOCSIFFLAGS, &flags) < 0) {
206    printf("Can't bring %s up: %s\n", name, strerror(errno));
207    return false;
208  }
209
210  /*
211   * Set interface netmask
212   */
213  rtems_bsdnet_initialize_sockaddr_in(&netmask);
214  netmask.sin_addr.s_addr = inet_addr(ip_netmask);
215  if (rtems_bsdnet_ifconfig(name, SIOCSIFNETMASK, &netmask) < 0) {
216    printf("Can't set %s netmask: %s\n", name, strerror(errno));
217    return false;
218  }
219
220  /*
221   * Set interface address
222   */
223  rtems_bsdnet_initialize_sockaddr_in(&address);
224  address.sin_addr.s_addr = inet_addr(ip_address);
225  if (rtems_bsdnet_ifconfig(name, SIOCSIFADDR, &address) < 0) {
226    printf("Can't set %s address: %s\n", name, strerror(errno));
227    return false;
228  }
229
230  /*
231   * Set interface broadcast address if the interface has the
232   * broadcast flag set.
233   */
234  if (rtems_bsdnet_ifconfig(name, SIOCGIFFLAGS, &flags) < 0) {
235    printf("Can't read %s flags: %s\n", name, strerror(errno));
236    return false;
237  }
238
239  if (flags & IFF_BROADCAST) {
240    struct sockaddr_in broadcast;
241
242    rtems_bsdnet_initialize_sockaddr_in(&broadcast);
243    broadcast.sin_addr.s_addr =
244        address.sin_addr.s_addr | ~netmask.sin_addr.s_addr;
245    if (rtems_bsdnet_ifconfig(name, SIOCSIFBRDADDR, &broadcast) < 0) {
246      struct in_addr  in_addr;
247      char      buf[20];
248      in_addr.s_addr = broadcast.sin_addr.s_addr;
249      if (!inet_ntop(AF_INET, &in_addr, buf, sizeof(buf)))
250          strcpy(buf,"?.?.?.?");
251      printf("Can't set %s broadcast address %s: %s\n",
252        name, buf, strerror(errno));
253    }
254  }
255
256  return true;
257}
258
259
260
261void rtems_initialize_interfaces(void)
262{
263  bool                          any_if_configured;
264  struct rtems_bsdnet_ifconfig *ifp;
265
266  any_if_configured = false;
267
268  any_if_configured |= rtems_bsdnet_setup_interface(
269    "lo0",
270    "127.0.0.1",
271    "255.0.0.0"
272  );
273
274
275  for (ifp = rtems_bsdnet_config.ifconfig ; ifp ; ifp = ifp->next) {
276    if (ifp->ip_address == NULL)
277      continue;
278
279    any_if_configured |= rtems_bsdnet_setup_interface(
280      ifp->name,
281      ifp->ip_address,
282      ifp->ip_netmask
283    );
284  }
285  /*
286   * Set default route
287   */
288  if (rtems_bsdnet_config.gateway && any_if_configured) {
289    struct sockaddr_in address;
290    struct sockaddr_in netmask;
291    struct sockaddr_in gateway;
292
293    rtems_bsdnet_initialize_sockaddr_in(&address);
294    rtems_bsdnet_initialize_sockaddr_in(&netmask);
295    rtems_bsdnet_initialize_sockaddr_in(&gateway);
296
297    gateway.sin_addr.s_addr = inet_addr (rtems_bsdnet_config.gateway);
298
299    if (rtems_bsdnet_rtrequest (
300        RTM_ADD,
301        (struct sockaddr *)&address,
302        (struct sockaddr *)&gateway,
303        (struct sockaddr *)&netmask,
304        (RTF_UP | RTF_GATEWAY | RTF_STATIC), NULL) < 0) {
305      printf ("Can't set default route: %s\n", strerror (errno));
306      return -1;
307    }
308  }
309  return 0;
310
311}
Note: See TracBrowser for help on using the repository browser.