79 lines
1.5 KiB
C
79 lines
1.5 KiB
C
|
|
||
|
|
#include <string.h>
|
||
|
|
#include <errno.h>
|
||
|
|
#include <stdio.h>
|
||
|
|
#include <errno.h>
|
||
|
|
|
||
|
|
#include "mac_table.h"
|
||
|
|
#include "utils.h"
|
||
|
|
|
||
|
|
|
||
|
|
bool mac_table_contains(struct mac_table *tbl, const uint8_t *addr)
|
||
|
|
{
|
||
|
|
unsigned int i;
|
||
|
|
for (i = 0; i < tbl->num_entries; i++) {
|
||
|
|
if (!memcmp(tbl->addr[i], addr, 6))
|
||
|
|
return true;
|
||
|
|
}
|
||
|
|
return false;
|
||
|
|
}
|
||
|
|
|
||
|
|
int mac_table_add(struct mac_table *tbl, const uint8_t *addr)
|
||
|
|
{
|
||
|
|
if (tbl->num_entries == MAC_TABLE_SIZE-1)
|
||
|
|
return -ENOSPC;
|
||
|
|
|
||
|
|
memcpy(tbl->addr[tbl->num_entries++], addr, 6);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
void mac_table_init(struct mac_table *tbl, const char *name)
|
||
|
|
{
|
||
|
|
memset(tbl, 0, sizeof(*tbl));
|
||
|
|
tbl->name = name;
|
||
|
|
}
|
||
|
|
|
||
|
|
int mac_table_read(struct mac_table *tbl, const char *fname)
|
||
|
|
{
|
||
|
|
FILE *f = fopen(fname, "r");
|
||
|
|
unsigned int num = 0;
|
||
|
|
char line[256];
|
||
|
|
|
||
|
|
if (!f) {
|
||
|
|
fprintf(stderr, "Cannot open mac table %s: %s\n", fname, strerror(errno));
|
||
|
|
return -errno;
|
||
|
|
}
|
||
|
|
|
||
|
|
printf("Reading MAC table %s from file %s...\n", tbl->name, fname);
|
||
|
|
|
||
|
|
while (fgets(line, sizeof(line), f)) {
|
||
|
|
uint8_t addr[6];
|
||
|
|
int rc;
|
||
|
|
|
||
|
|
if (line[strlen(line)-1] == '\n')
|
||
|
|
line[strlen(line)-1] = 0;
|
||
|
|
|
||
|
|
if (strlen(line) < 1)
|
||
|
|
continue;
|
||
|
|
|
||
|
|
/* skip comments */
|
||
|
|
if (line[0] == ';' || line[9] == '#')
|
||
|
|
continue;
|
||
|
|
|
||
|
|
rc = sscanf(line, "%02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx",
|
||
|
|
&addr[0], &addr[1], &addr[2], &addr[3], &addr[4], &addr[5]);
|
||
|
|
if (rc != 6) {
|
||
|
|
fprintf(stderr, "%s: Cannot parse line '%s'\n", tbl->name, line);
|
||
|
|
continue;
|
||
|
|
}
|
||
|
|
printf("%s: Read MAC address %s\n", tbl->name, mac2str(addr));
|
||
|
|
|
||
|
|
mac_table_add(tbl, addr);
|
||
|
|
num++;
|
||
|
|
}
|
||
|
|
fclose(f);
|
||
|
|
|
||
|
|
return num;
|
||
|
|
}
|