/
usb_moded-mac.c
127 lines (107 loc) · 3.29 KB
1
/**
2
3
* @file usb_moded-mac.c
*
4
* Copyright (C) 2013-2019 Jolla. All rights reserved.
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
*
* @author: Philippe De Swert <philippe.deswert@jollamobile.com>
* @author: Simo Piiroinen <simo.piiroinen@jollamobile.com>
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the Lesser GNU General Public License
* version 2 as published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful, but
* WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* General Public License for more details.
*
* You should have received a copy of the Lesser GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
* 02110-1301 USA
*/
23
24
#include "usb_moded-mac.h"
25
26
#include "usb_moded-log.h"
27
28
29
30
31
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
32
33
34
/* ========================================================================= *
* Prototypes
* ========================================================================= */
35
36
37
38
/* ------------------------------------------------------------------------- *
* MAC
* ------------------------------------------------------------------------- */
39
40
41
42
static void mac_random_ether_addr (unsigned char *addr);
void mac_generate_random_mac(void);
char *mac_read_mac (void);
43
44
45
46
/* ========================================================================= *
* Functions
* ========================================================================= */
47
48
static void mac_random_ether_addr(unsigned char *addr)
49
{
50
51
LOG_REGISTER_CONTEXT;
52
53
FILE *random;
size_t count = 0;
54
55
56
57
random = fopen("/dev/urandom", "r");
count = fread(addr, 1, 6, random);
fclose(random);
58
59
60
61
62
63
64
65
if(count > 0 )
{
addr [0] &= 0xfe; /* clear multicast bit */
addr [0] |= 0x02; /* set local assignment bit (IEEE802) */
}
else
log_warning("MAC generation failed!\n");
66
67
}
68
void mac_generate_random_mac (void)
69
{
70
71
LOG_REGISTER_CONTEXT;
72
73
74
75
76
77
78
79
80
81
82
83
84
85
unsigned char addr[6];
int i;
FILE *g_ether;
log_debug("Getting random usb ethernet mac\n");
mac_random_ether_addr(addr);
g_ether = fopen("/etc/modprobe.d/g_ether.conf", "w");
if(!g_ether)
{
log_warning("Failed to write mac address to /etc/modprobe.d/g_ether.conf\n");
return;
}
fprintf(g_ether, "options g_ether host_addr=");
86
87
88
89
90
91
92
for(i=0; i<5; i++)
{
fprintf(g_ether, "%02x:",addr[i]);
}
fprintf(g_ether, "%02x\n",addr[i]);
fclose(g_ether);
93
}
94
95
char * mac_read_mac(void)
96
{
97
98
LOG_REGISTER_CONTEXT;
99
100
101
102
FILE *g_ether;
char *mac = NULL, *ret = NULL;
size_t read = 0;
int test = 0;
103
104
105
106
107
g_ether = fopen("/etc/modprobe.d/g_ether.conf", "r");
if(!g_ether)
{
log_warning("Failed to read mac address from /etc/modprobe.d/g_ether.conf\n");
108
return NULL;
109
110
111
112
113
114
115
}
test = fseek(g_ether, 26, SEEK_SET);
if(test == -1)
{
fclose(g_ether);
return 0;
}
116
mac = malloc(17);
117
118
119
120
121
122
if(mac)
read = fread(mac, 1, 17, g_ether);
if(read == 17)
ret = strndup(mac,17);
else
ret = 0;
123
124
125
free(mac);
fclose(g_ether);
126
return ret;
127
}