int is_our_address(ipv6_addr_t *addr) { ipv6_net_if_ext_t *net_if_ext; ipv6_net_if_addr_t *myaddr; uint8_t prefix, suffix; int if_id = -1; DEBUGF("Is this my addres: %s?\n", ipv6_addr_to_str(addr_str, IPV6_MAX_ADDR_STR_LEN, addr)); while ((if_id = net_if_iter_interfaces(if_id)) >= 0) { net_if_ext = ipv6_net_if_get_ext(if_id); myaddr = NULL; prefix = net_if_ext->prefix / 8; suffix = IPV6_ADDR_LEN - prefix; while ((myaddr = (ipv6_net_if_addr_t *)net_if_iter_addresses(if_id, (net_if_addr_t **) &myaddr)) != NULL) { DEBUGF("\tCompare with: %s?\n", ipv6_addr_to_str(addr_str, IPV6_MAX_ADDR_STR_LEN, (ipv6_addr_t*) myaddr->addr_data)); if ((ipv6_get_addr_match(myaddr->addr_data, addr) >= net_if_ext->prefix) && (memcmp(&addr->uint8[prefix], &myaddr->addr_data->uint8[prefix], suffix) == 0)) { return 1; } } } return 0; }
ipv6_net_if_hit_t *ipv6_net_if_addr_match(ipv6_net_if_hit_t *hit, const ipv6_addr_t *addr) { int if_id = -1; ipv6_net_if_addr_t *addr_entry = NULL; while ((if_id = net_if_iter_interfaces(if_id)) >= 0) { while (net_if_iter_addresses(if_id, (net_if_addr_t **) &addr_entry) != NULL) { if (addr_entry->addr_protocol & NET_IF_L3P_IPV6) { uint8_t byte_al = addr_entry->addr_len / 8; uint8_t mask[] = {0x00, 0x80, 0xc0, 0xe0, 0xf0, 0xf8, 0xfc, 0xfe }; if (memcmp(addr_entry->addr_data, addr, byte_al) == 0 && (addr_entry->addr_len % 8 == 0 || ((addr_entry->addr_data->uint8[byte_al] - addr->uint8[byte_al]) & mask[addr_entry->addr_len - (byte_al * 8)]))) { hit->if_id = if_id; hit->addr = addr_entry; return hit; } } } } return NULL; }
/** * @brief Check if the given IPv6 address is assigned to any configured * interface * * @param[in] addr The IPv6 address to check * * @return 1 If *addr* is assigned to at least one interface * @return 0 If *addr* is not assigned to any interface * @return -1 If no IPv6 address is configured to any interface */ static int is_our_address(ipv6_addr_t *addr) { int if_id = -1; int if_counter = -1; DEBUGF("Is this my addres: %s?\n", ipv6_addr_to_str(addr_str, IPV6_MAX_ADDR_STR_LEN, addr)); while ((if_id = net_if_iter_interfaces(if_id)) >= 0) { ipv6_net_if_ext_t *net_if_ext = ipv6_net_if_get_ext(if_id); ipv6_net_if_addr_t *myaddr = NULL; uint8_t prefix = net_if_ext->prefix / 8; uint8_t suffix = IPV6_ADDR_LEN - prefix; while ((myaddr = (ipv6_net_if_addr_t *)net_if_iter_addresses(if_id, (net_if_addr_t **) &myaddr)) != NULL) { if_counter++; DEBUGF("\tCompare with: %s?\n", ipv6_addr_to_str(addr_str, IPV6_MAX_ADDR_STR_LEN, (ipv6_addr_t*) myaddr->addr_data)); if ((ipv6_get_addr_match(myaddr->addr_data, addr) >= net_if_ext->prefix) && (memcmp(&addr->uint8[prefix], &myaddr->addr_data->uint8[prefix], suffix) == 0)) { return 1; } } } /* return negative value if no address is configured so far */ if (if_counter >= 0) { return 0; } return -1; }
int sixlowpan_mac_init(void) { int recv_pid = thread_create(radio_stack_buffer, RADIO_STACK_SIZE, PRIORITY_MAIN - 2, CREATE_STACKTEST, recv_ieee802154_frame, NULL, "radio"); int if_id = -1; while ((if_id = net_if_iter_interfaces(if_id)) >= 0) { net_if_register(if_id, recv_pid); } macdsn = rand() % 256; return recv_pid; }
int ipv6_init_as_router(void) { ipv6_addr_t addr; int if_id = -1; ipv6_addr_set_all_routers_addr(&addr); while ((if_id = net_if_iter_interfaces(if_id)) >= 0) { if (!ipv6_net_if_add_addr(if_id, &addr, NDP_ADDR_STATE_PREFERRED, 0, 0, 0)) { return 0; } } return 1; }
ipv6_net_if_hit_t *ipv6_net_if_addr_prefix_eq(ipv6_net_if_hit_t *hit, ipv6_addr_t *addr) { int if_id = -1; ipv6_net_if_addr_t *addr_entry = NULL; while ((if_id = net_if_iter_interfaces(if_id)) >= 0) { while (net_if_iter_addresses(if_id, (net_if_addr_t **) &addr_entry) != NULL) { if (addr_entry->addr_protocol & NET_IF_L3P_IPV6) { if (memcmp(addr_entry->addr_data, &addr, 8) == 0) { hit->if_id = if_id; hit->addr = addr_entry; return hit; } } } } return NULL; }
int net_if_send_packet_broadcast(net_if_trans_addr_m_t preferred_dest_mode, const void *payload, size_t payload_len) { int if_id = -1; int res = 0, res_prev = 0; while ((if_id = net_if_iter_interfaces(if_id)) >= 0) { if (interfaces[if_id].transceivers & (TRANSCEIVER_CC1100 | TRANSCEIVER_NATIVE)) { res = net_if_send_packet(if_id, 0, payload, payload_len); } else if (preferred_dest_mode == NET_IF_TRANS_ADDR_M_SHORT) { res = net_if_send_packet(if_id, IEEE_802154_SHORT_MCAST_ADDR, payload, payload_len); } else { net_if_eui64_t mcast_addr = IEEE_802154_LONG_MCAST_ADDR; res = net_if_send_packet_long(if_id, &mcast_addr, payload, payload_len); } if (res_prev != 0) { if (res != res_prev) { return -1; } } else { if (res == 0) { break; } } res_prev = res; } return res; }
int is_our_address(ipv6_addr_t *addr) { ipv6_net_if_ext_t *net_if_ext; ipv6_net_if_addr_t *myaddr; uint8_t prefix, suffix; int if_id = -1; while ((if_id = net_if_iter_interfaces(if_id)) >= 0) { net_if_ext = ipv6_net_if_get_ext(if_id); myaddr = NULL; prefix = net_if_ext->prefix / 8; suffix = IPV6_ADDR_LEN - prefix; while ((myaddr = (ipv6_net_if_addr_t *)net_if_iter_addresses(if_id, (net_if_addr_t **) &myaddr)) != NULL) { if ((ipv6_get_addr_match(myaddr->addr_data, addr) >= net_if_ext->prefix) && (memcmp(&addr->uint8[prefix], &myaddr->addr_data->uint8[prefix], suffix) == 0)) { return 1; } } } return 0; }
int main(void) { int iface; char *addr1_data = "abcdefgh", *addr2_data = "12345678"; net_if_addr_t addr1 = { .addr_next = NULL, .addr_prev = NULL, .addr_protocol = NET_IF_L3P_IPV6_MULTICAST, .addr_data = (void *)addr1_data, .addr_len = (strlen(addr1_data) + 1) * 8 }; net_if_addr_t addr2 = { .addr_next = NULL, .addr_prev = NULL, .addr_protocol = NET_IF_L3P_IPV6_PREFIX, .addr_data = (void *)addr2_data, .addr_len = (strlen(addr2_data) + 1) * 8 }; uint16_t own = 1, target = 2; net_if_eui64_t eui64; iface = initialize_tests(); if (!test_net_if_initialization(iface)) { printf("FAILED: test_net_if_initialization()\n"); return -1; } if (!test_net_if_get_add_l3p_types(iface)) { printf("FAILED: test_net_if_get_add_l3p_types()\n"); return -1; } if (!test_net_if_add_address(iface, &addr1, &addr2)) { printf("FAILED: test_net_if_add_address()\n"); return -1; } if (!test_net_if_del_address(iface, &addr1, &addr2)) { printf("FAILED: test_net_if_del_address()\n"); return -1; } if (!test_net_if_get_set_hardware_address(iface, own)) { printf("FAILED: test_net_if_get_set_hardware_address()\n"); return -1; } if (!test_net_if_get_set_pan_id(iface)) { printf("FAILED: test_net_if_get_set_pan_id()\n"); return -1; } if (!test_net_if_get_set_eui64(iface, &eui64, own)) { printf("FAILED: test_net_if_get_set_eui64()\n"); return -1; } int count = net_if_send_packet(iface, target, "Test", 4); printf("Count was %i after net_if_send_packet()\n", count); printf("All test ran successfully.\n"); return 0; } int initialize_tests(void) { int iface; #ifndef MODULE_AUTO_INIT transceiver_init(TRANSCEIVER); transceiver_start(); net_if_init(); iface = net_if_init_interface(0, TRANSCEIVER); return iface; #else iface = -1; while ((iface = net_if_iter_interfaces(iface)) >= 0) { return iface; } return iface; #endif } int test_net_if_initialization(int iface) { net_if_addr_t *addr_ptr = NULL; if (net_if_get_l3p_types(iface)) { printf("FAILED: No L3 type expected on interface %d.\n", iface); return 0; } if (net_if_iter_addresses(iface + 1, &addr_ptr)) { printf("FAILED: Expected error on interface '%d'\n", iface + 1); return 0; } if (net_if_iter_addresses(iface, &addr_ptr)) { printf("FAILED: Expected error on interface '%d'\n", iface); return 0; } return 1; }