source: mainline/uspace/srv/net/ethip/ethip_nic.c@ a46e56b

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since a46e56b was a46e56b, checked in by Jakub Jermar <jakub@…>, 7 years ago

Prefer handle over ID in naming handle variables
  • Property mode set to 100644
File size: 11.7 KB
Line 
1/*
2 * Copyright (c) 2012 Jiri Svoboda
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 *
9 * - Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * - Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * - The name of the author may not be used to endorse or promote products
15 * derived from this software without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 */
28
29/** @addtogroup ethip
30 * @{
31 */
32/**
33 * @file
34 * @brief
35 */
36
37#include <adt/list.h>
38#include <async.h>
39#include <stdbool.h>
40#include <errno.h>
41#include <str_error.h>
42#include <fibril_synch.h>
43#include <inet/iplink_srv.h>
44#include <io/log.h>
45#include <loc.h>
46#include <nic_iface.h>
47#include <stdlib.h>
48#include <mem.h>
49#include "ethip.h"
50#include "ethip_nic.h"
51#include "pdu.h"
52
53static errno_t ethip_nic_open(service_id_t sid);
54static void ethip_nic_cb_conn(cap_call_handle_t icall_handle, ipc_call_t *icall, void *arg);
55
56static LIST_INITIALIZE(ethip_nic_list);
57static FIBRIL_MUTEX_INITIALIZE(ethip_discovery_lock);
58
59static errno_t ethip_nic_check_new(void)
60{
61 bool already_known;
62 category_id_t iplink_cat;
63 service_id_t *svcs;
64 size_t count, i;
65 errno_t rc;
66
67 fibril_mutex_lock(&ethip_discovery_lock);
68
69 rc = loc_category_get_id("nic", &iplink_cat, IPC_FLAG_BLOCKING);
70 if (rc != EOK) {
71 log_msg(LOG_DEFAULT, LVL_ERROR, "Failed resolving category 'nic'.");
72 fibril_mutex_unlock(&ethip_discovery_lock);
73 return ENOENT;
74 }
75
76 rc = loc_category_get_svcs(iplink_cat, &svcs, &count);
77 if (rc != EOK) {
78 log_msg(LOG_DEFAULT, LVL_ERROR, "Failed getting list of IP links.");
79 fibril_mutex_unlock(&ethip_discovery_lock);
80 return EIO;
81 }
82
83 for (i = 0; i < count; i++) {
84 already_known = false;
85
86 list_foreach(ethip_nic_list, link, ethip_nic_t, nic) {
87 if (nic->svc_id == svcs[i]) {
88 already_known = true;
89 break;
90 }
91 }
92
93 if (!already_known) {
94 log_msg(LOG_DEFAULT, LVL_DEBUG, "Found NIC '%lu'",
95 (unsigned long) svcs[i]);
96 rc = ethip_nic_open(svcs[i]);
97 if (rc != EOK)
98 log_msg(LOG_DEFAULT, LVL_ERROR, "Could not open NIC.");
99 }
100 }
101
102 fibril_mutex_unlock(&ethip_discovery_lock);
103 return EOK;
104}
105
106static ethip_nic_t *ethip_nic_new(void)
107{
108 ethip_nic_t *nic = calloc(1, sizeof(ethip_nic_t));
109 if (nic == NULL) {
110 log_msg(LOG_DEFAULT, LVL_ERROR, "Failed allocating NIC structure. "
111 "Out of memory.");
112 return NULL;
113 }
114
115 link_initialize(&nic->link);
116 list_initialize(&nic->addr_list);
117
118 return nic;
119}
120
121static ethip_link_addr_t *ethip_nic_addr_new(inet_addr_t *addr)
122{
123 ethip_link_addr_t *laddr = calloc(1, sizeof(ethip_link_addr_t));
124 if (laddr == NULL) {
125 log_msg(LOG_DEFAULT, LVL_ERROR, "Failed allocating NIC address structure. "
126 "Out of memory.");
127 return NULL;
128 }
129
130 link_initialize(&laddr->link);
131 laddr->addr = *addr;
132
133 return laddr;
134}
135
136static void ethip_nic_delete(ethip_nic_t *nic)
137{
138 if (nic->svc_name != NULL)
139 free(nic->svc_name);
140
141 free(nic);
142}
143
144static void ethip_link_addr_delete(ethip_link_addr_t *laddr)
145{
146 free(laddr);
147}
148
149static errno_t ethip_nic_open(service_id_t sid)
150{
151 bool in_list = false;
152 nic_address_t nic_address;
153
154 log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_nic_open()");
155 ethip_nic_t *nic = ethip_nic_new();
156 if (nic == NULL)
157 return ENOMEM;
158
159 errno_t rc = loc_service_get_name(sid, &nic->svc_name);
160 if (rc != EOK) {
161 log_msg(LOG_DEFAULT, LVL_ERROR, "Failed getting service name.");
162 goto error;
163 }
164
165 nic->sess = loc_service_connect(sid, INTERFACE_DDF, 0);
166 if (nic->sess == NULL) {
167 log_msg(LOG_DEFAULT, LVL_ERROR, "Failed connecting '%s'", nic->svc_name);
168 goto error;
169 }
170
171 nic->svc_id = sid;
172
173 rc = nic_callback_create(nic->sess, ethip_nic_cb_conn, nic);
174 if (rc != EOK) {
175 log_msg(LOG_DEFAULT, LVL_ERROR, "Failed creating callback connection "
176 "from '%s'", nic->svc_name);
177 goto error;
178 }
179
180 log_msg(LOG_DEFAULT, LVL_DEBUG, "Opened NIC '%s'", nic->svc_name);
181 list_append(&nic->link, &ethip_nic_list);
182 in_list = true;
183
184 rc = ethip_iplink_init(nic);
185 if (rc != EOK)
186 goto error;
187
188 rc = nic_get_address(nic->sess, &nic_address);
189 if (rc != EOK) {
190 log_msg(LOG_DEFAULT, LVL_ERROR, "Error getting MAC address of NIC '%s'.",
191 nic->svc_name);
192 goto error;
193 }
194
195 addr48(nic_address.address, nic->mac_addr);
196
197 rc = nic_set_state(nic->sess, NIC_STATE_ACTIVE);
198 if (rc != EOK) {
199 log_msg(LOG_DEFAULT, LVL_ERROR, "Error activating NIC '%s'.",
200 nic->svc_name);
201 goto error;
202 }
203
204 rc = nic_broadcast_set_mode(nic->sess, NIC_BROADCAST_ACCEPTED);
205 if (rc != EOK) {
206 log_msg(LOG_DEFAULT, LVL_ERROR, "Error enabling "
207 "reception of broadcast frames on '%s'.", nic->svc_name);
208 goto error;
209 }
210
211 log_msg(LOG_DEFAULT, LVL_DEBUG, "Initialized IP link service,");
212
213 return EOK;
214
215error:
216 if (in_list)
217 list_remove(&nic->link);
218
219 if (nic->sess != NULL)
220 async_hangup(nic->sess);
221
222 ethip_nic_delete(nic);
223 return rc;
224}
225
226static void ethip_nic_cat_change_cb(void)
227{
228 (void) ethip_nic_check_new();
229}
230
231static void ethip_nic_addr_changed(ethip_nic_t *nic, cap_call_handle_t chandle,
232 ipc_call_t *call)
233{
234 uint8_t *addr;
235 size_t size;
236 errno_t rc;
237
238 rc = async_data_write_accept((void **)&addr, false, 0, 0, 0, &size);
239 if (rc != EOK) {
240 log_msg(LOG_DEFAULT, LVL_DEBUG, "data_write_accept() failed");
241 return;
242 }
243
244 log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_nic_addr_changed(): "
245 "new addr=%02x:%02x:%02x:%02x:%02x:%02x",
246 addr[0], addr[1], addr[2], addr[3], addr[4], addr[5]);
247
248 memcpy(&nic->mac_addr, addr, sizeof(nic->mac_addr));
249
250 rc = iplink_ev_change_addr(&nic->iplink, &nic->mac_addr);
251 if (rc != EOK) {
252 log_msg(LOG_DEFAULT, LVL_DEBUG, "iplink_ev_change_addr() failed");
253 return;
254 }
255
256 free(addr);
257 async_answer_0(chandle, EOK);
258}
259
260static void ethip_nic_received(ethip_nic_t *nic, cap_call_handle_t chandle,
261 ipc_call_t *call)
262{
263 errno_t rc;
264 void *data;
265 size_t size;
266
267 log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_nic_received() nic=%p", nic);
268
269 rc = async_data_write_accept(&data, false, 0, 0, 0, &size);
270 if (rc != EOK) {
271 log_msg(LOG_DEFAULT, LVL_DEBUG, "data_write_accept() failed");
272 return;
273 }
274
275 log_msg(LOG_DEFAULT, LVL_DEBUG, "Ethernet PDU contents (%zu bytes)",
276 size);
277
278 log_msg(LOG_DEFAULT, LVL_DEBUG, "call ethip_received");
279 rc = ethip_received(&nic->iplink, data, size);
280 log_msg(LOG_DEFAULT, LVL_DEBUG, "free data");
281 free(data);
282
283 log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_nic_received() done, rc=%s", str_error_name(rc));
284 async_answer_0(chandle, rc);
285}
286
287static void ethip_nic_device_state(ethip_nic_t *nic, cap_call_handle_t chandle,
288 ipc_call_t *call)
289{
290 log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_nic_device_state()");
291 async_answer_0(chandle, ENOTSUP);
292}
293
294static void ethip_nic_cb_conn(cap_call_handle_t icall_handle, ipc_call_t *icall, void *arg)
295{
296 ethip_nic_t *nic = (ethip_nic_t *)arg;
297
298 log_msg(LOG_DEFAULT, LVL_DEBUG, "ethnip_nic_cb_conn()");
299
300 while (true) {
301 ipc_call_t call;
302 cap_call_handle_t chandle = async_get_call(&call);
303
304 if (!IPC_GET_IMETHOD(call)) {
305 /* TODO: Handle hangup */
306 return;
307 }
308
309 switch (IPC_GET_IMETHOD(call)) {
310 case NIC_EV_ADDR_CHANGED:
311 ethip_nic_addr_changed(nic, chandle, &call);
312 break;
313 case NIC_EV_RECEIVED:
314 ethip_nic_received(nic, chandle, &call);
315 break;
316 case NIC_EV_DEVICE_STATE:
317 ethip_nic_device_state(nic, chandle, &call);
318 break;
319 default:
320 log_msg(LOG_DEFAULT, LVL_DEBUG, "unknown IPC method: %" PRIun, IPC_GET_IMETHOD(call));
321 async_answer_0(chandle, ENOTSUP);
322 }
323 }
324}
325
326errno_t ethip_nic_discovery_start(void)
327{
328 errno_t rc = loc_register_cat_change_cb(ethip_nic_cat_change_cb);
329 if (rc != EOK) {
330 log_msg(LOG_DEFAULT, LVL_ERROR, "Failed registering callback for NIC "
331 "discovery: %s.", str_error(rc));
332 return rc;
333 }
334
335 return ethip_nic_check_new();
336}
337
338ethip_nic_t *ethip_nic_find_by_iplink_sid(service_id_t iplink_sid)
339{
340 log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_nic_find_by_iplink_sid(%u)",
341 (unsigned) iplink_sid);
342
343 list_foreach(ethip_nic_list, link, ethip_nic_t, nic) {
344 log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_nic_find_by_iplink_sid - element");
345 if (nic->iplink_sid == iplink_sid) {
346 log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_nic_find_by_iplink_sid - found %p", nic);
347 return nic;
348 }
349 }
350
351 log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_nic_find_by_iplink_sid - not found");
352 return NULL;
353}
354
355errno_t ethip_nic_send(ethip_nic_t *nic, void *data, size_t size)
356{
357 errno_t rc;
358 log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_nic_send(size=%zu)", size);
359 rc = nic_send_frame(nic->sess, data, size);
360 log_msg(LOG_DEFAULT, LVL_DEBUG, "nic_send_frame -> %s", str_error_name(rc));
361 return rc;
362}
363
364/** Setup accepted multicast addresses
365 *
366 * Currently the set of accepted multicast addresses is
367 * determined only based on IPv6 addresses.
368 *
369 */
370static errno_t ethip_nic_setup_multicast(ethip_nic_t *nic)
371{
372 log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_nic_setup_multicast()");
373
374 /* Count the number of multicast addresses */
375
376 size_t count = 0;
377
378 list_foreach(nic->addr_list, link, ethip_link_addr_t, laddr) {
379 ip_ver_t ver = inet_addr_get(&laddr->addr, NULL, NULL);
380 if (ver == ip_v6)
381 count++;
382 }
383
384 if (count == 0)
385 return nic_multicast_set_mode(nic->sess, NIC_MULTICAST_BLOCKED,
386 NULL, 0);
387
388 nic_address_t *mac_list = calloc(count, sizeof(nic_address_t));
389 if (mac_list == NULL)
390 return ENOMEM;
391
392 /* Create the multicast MAC list */
393
394 size_t i = 0;
395
396 list_foreach(nic->addr_list, link, ethip_link_addr_t, laddr) {
397 addr128_t v6;
398 ip_ver_t ver = inet_addr_get(&laddr->addr, NULL, &v6);
399 if (ver != ip_v6)
400 continue;
401
402 assert(i < count);
403
404 addr48_t mac;
405 addr48_solicited_node(v6, mac);
406
407 /* Avoid duplicate addresses in the list */
408
409 bool found = false;
410
411 for (size_t j = 0; j < i; j++) {
412 if (addr48_compare(mac_list[j].address, mac)) {
413 found = true;
414 break;
415 }
416 }
417
418 if (!found) {
419 addr48(mac, mac_list[i].address);
420 i++;
421 } else
422 count--;
423 }
424
425 /* Setup the multicast MAC list */
426
427 errno_t rc = nic_multicast_set_mode(nic->sess, NIC_MULTICAST_LIST,
428 mac_list, count);
429
430 free(mac_list);
431 return rc;
432}
433
434errno_t ethip_nic_addr_add(ethip_nic_t *nic, inet_addr_t *addr)
435{
436 log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_nic_addr_add()");
437
438 ethip_link_addr_t *laddr = ethip_nic_addr_new(addr);
439 if (laddr == NULL)
440 return ENOMEM;
441
442 list_append(&laddr->link, &nic->addr_list);
443
444 return ethip_nic_setup_multicast(nic);
445}
446
447errno_t ethip_nic_addr_remove(ethip_nic_t *nic, inet_addr_t *addr)
448{
449 log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_nic_addr_remove()");
450
451 ethip_link_addr_t *laddr = ethip_nic_addr_find(nic, addr);
452 if (laddr == NULL)
453 return ENOENT;
454
455 list_remove(&laddr->link);
456 ethip_link_addr_delete(laddr);
457
458 return ethip_nic_setup_multicast(nic);
459}
460
461ethip_link_addr_t *ethip_nic_addr_find(ethip_nic_t *nic,
462 inet_addr_t *addr)
463{
464 log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_nic_addr_find()");
465
466 list_foreach(nic->addr_list, link, ethip_link_addr_t, laddr) {
467 if (inet_addr_compare(addr, &laddr->addr))
468 return laddr;
469 }
470
471 return NULL;
472}
473
474/** @}
475 */
Note: See TracBrowser for help on using the repository browser.