1 | #ifndef ADDRESSDISCOVERY_HPP_
|
---|
2 | #define ADDRESSDISCOVERY_HPP_
|
---|
3 |
|
---|
4 | #include "ariba/utility/addressing/addressing.hpp"
|
---|
5 |
|
---|
6 | #include <sys/types.h>
|
---|
7 | #include <sys/socket.h>
|
---|
8 | #include <sys/ioctl.h>
|
---|
9 | #include <sys/socket.h>
|
---|
10 |
|
---|
11 | #include <arpa/inet.h>
|
---|
12 |
|
---|
13 | #include <netinet/in.h>
|
---|
14 |
|
---|
15 | #include <net/if.h>
|
---|
16 |
|
---|
17 | #include <ifaddrs.h>
|
---|
18 |
|
---|
19 | #include <bluetooth/bluetooth.h>
|
---|
20 | #include <bluetooth/hci.h>
|
---|
21 | #include <bluetooth/hci_lib.h>
|
---|
22 |
|
---|
23 | using namespace ariba::addressing;
|
---|
24 |
|
---|
25 | mac_address getMacFromIF( const char* name ) {
|
---|
26 | int s;
|
---|
27 | struct ifreq buffer;
|
---|
28 | s = socket(PF_INET, SOCK_DGRAM, 0);
|
---|
29 | memset(&buffer, 0x00, sizeof(buffer));
|
---|
30 | strcpy(buffer.ifr_name, name);
|
---|
31 | ioctl(s, SIOCGIFHWADDR, &buffer);
|
---|
32 | close(s);
|
---|
33 | mac_address addr;
|
---|
34 | addr.assign( (uint8_t*)buffer.ifr_hwaddr.sa_data, 6 );
|
---|
35 | return addr;
|
---|
36 | }
|
---|
37 |
|
---|
38 |
|
---|
39 | int dev_info(int s, int dev_id, long arg) {
|
---|
40 | endpoint_set* set = (endpoint_set*)arg;
|
---|
41 | struct hci_dev_info di;
|
---|
42 | di.dev_id = dev_id;
|
---|
43 | if (ioctl(s, HCIGETDEVINFO, (void *) &di)) return 0;
|
---|
44 | mac_address mac;
|
---|
45 | mac.bluetooth( di.bdaddr );
|
---|
46 | address_vf vf = mac;
|
---|
47 | set->add(vf);
|
---|
48 | return 0;
|
---|
49 | }
|
---|
50 |
|
---|
51 | void discover_bluetooth( endpoint_set& endpoints ) {
|
---|
52 | hci_for_each_dev(HCI_UP, &dev_info, (long)&endpoints );
|
---|
53 | }
|
---|
54 |
|
---|
55 | void discover_ip_addresses( endpoint_set& endpoints ) {
|
---|
56 | struct ifaddrs* ifaceBuffer = NULL;
|
---|
57 | struct ifaddrs* tmpAddr = NULL;
|
---|
58 | void* tmpAddrPtr = NULL;
|
---|
59 | char straddr [INET_ADDRSTRLEN];
|
---|
60 |
|
---|
61 | int ret = getifaddrs( &ifaceBuffer );
|
---|
62 | if( ret != 0 ) return;
|
---|
63 |
|
---|
64 | for( struct ifaddrs* i=ifaceBuffer; i != NULL; i=i->ifa_next ) {
|
---|
65 |
|
---|
66 | // ignore devices that are disabled or have no ip
|
---|
67 | if(i == NULL) continue;
|
---|
68 | struct sockaddr* addr = i->ifa_addr;
|
---|
69 |
|
---|
70 | // only look at IPv4, not IPv6 addresses
|
---|
71 | if (addr->sa_family == AF_INET) {
|
---|
72 | if (addr==NULL) continue;
|
---|
73 | tmpAddrPtr= &((struct sockaddr_in*)addr)->sin_addr;
|
---|
74 | inet_ntop( i->ifa_addr->sa_family, tmpAddrPtr, straddr, sizeof(straddr) );
|
---|
75 | ip_address ip = straddr;
|
---|
76 | if (ip.is_loopback()) continue;
|
---|
77 | address_vf vf = ip;
|
---|
78 | endpoints.add( vf );
|
---|
79 | } else
|
---|
80 | if (addr->sa_family == AF_INET6) {
|
---|
81 | if (addr==NULL) continue;
|
---|
82 | tmpAddrPtr= &((struct sockaddr_in6*)addr)->sin6_addr;
|
---|
83 | inet_ntop( i->ifa_addr->sa_family, tmpAddrPtr, straddr, sizeof(straddr) );
|
---|
84 | ip_address ip = straddr;
|
---|
85 | if (ip.is_loopback()) continue;
|
---|
86 | address_vf vf = ip;
|
---|
87 | endpoints.add( vf );
|
---|
88 | } else
|
---|
89 | if (i->ifa_name[0]=='p' && i->ifa_name[1]=='a' && i->ifa_name[2]=='n') {
|
---|
90 | mac_address mac = getMacFromIF(i->ifa_name);
|
---|
91 | address_vf vf = mac;
|
---|
92 | // endpoints.add( vf );
|
---|
93 | }
|
---|
94 | }
|
---|
95 | }
|
---|
96 |
|
---|
97 | void discover_endpoints( endpoint_set& endpoints ) {
|
---|
98 | discover_ip_addresses( endpoints );
|
---|
99 | discover_bluetooth( endpoints );
|
---|
100 | }
|
---|
101 |
|
---|
102 | #endif /* ADDRESSDISCOVERY_HPP_ */
|
---|