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 | |
---|
15 | static 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 | */ |
---|
26 | int 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 | |
---|
47 | static void |
---|
48 | rtems_bsdnet_initialize_sockaddr_in(struct sockaddr_in *addr) |
---|
49 | { |
---|
50 | memcpy(addr, &address_template, sizeof(*addr)); |
---|
51 | } |
---|
52 | |
---|
53 | /* |
---|
54 | * Interface Configuration. |
---|
55 | */ |
---|
56 | int 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 | |
---|
191 | static 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 | |
---|
261 | void 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 | } |
---|