mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
75 lines
1.7 KiB
75 lines
1.7 KiB
// SPDX-License-Identifier: GPL-2.0+ |
|
/* |
|
* (C) Copyright 2016 |
|
* Olliver Schinagl <[email protected]> |
|
*/ |
|
|
|
#include <ctype.h> |
|
#include <stdbool.h> |
|
#include <stdint.h> |
|
#include <stdio.h> |
|
#include <stdlib.h> |
|
#include <string.h> |
|
#include <u-boot/crc.h> |
|
|
|
#define ARP_HLEN 6 /* Length of hardware address */ |
|
#define ARP_HLEN_ASCII (ARP_HLEN * 2) + (ARP_HLEN - 1) /* with separators */ |
|
#define ARP_HLEN_LAZY (ARP_HLEN * 2) /* separatorless hardware address length */ |
|
|
|
uint8_t nibble_to_hex(const char *nibble, bool lo) |
|
{ |
|
return (strtol(nibble, NULL, 16) << (lo ? 0 : 4)) & (lo ? 0x0f : 0xf0); |
|
} |
|
|
|
int process_mac(const char *mac_address) |
|
{ |
|
uint8_t ethaddr[ARP_HLEN + 1] = { 0x00 }; |
|
uint_fast8_t i = 0; |
|
|
|
while (*mac_address != '\0') { |
|
char nibble[2] = { 0x00, '\n' }; /* for strtol */ |
|
|
|
nibble[0] = *mac_address++; |
|
if (isxdigit(nibble[0])) { |
|
if (isupper(nibble[0])) |
|
nibble[0] = tolower(nibble[0]); |
|
ethaddr[i >> 1] |= nibble_to_hex(nibble, (i % 2) != 0); |
|
i++; |
|
} |
|
} |
|
|
|
for (i = 0; i < ARP_HLEN; i++) |
|
printf("%.2x", ethaddr[i]); |
|
printf("%.2x\n", crc8(0, ethaddr, ARP_HLEN)); |
|
|
|
return 0; |
|
} |
|
|
|
void print_usage(char *cmdname) |
|
{ |
|
printf("Usage: %s <mac_address>\n", cmdname); |
|
puts("<mac_address> may be with or without separators."); |
|
puts("Valid seperators are ':' and '-'."); |
|
puts("<mac_address> digits are in base 16.\n"); |
|
} |
|
|
|
int main(int argc, char *argv[]) |
|
{ |
|
if (argc < 2) { |
|
print_usage(argv[0]); |
|
return 1; |
|
} |
|
|
|
if (!((strlen(argv[1]) == ARP_HLEN_ASCII) || (strlen(argv[1]) == ARP_HLEN_LAZY))) { |
|
puts("The MAC address is not valid.\n"); |
|
print_usage(argv[0]); |
|
return 1; |
|
} |
|
|
|
if (process_mac(argv[1])) { |
|
puts("Failed to calculate the MAC's checksum."); |
|
return 1; |
|
} |
|
|
|
return 0; |
|
}
|
|
|