1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+ 2c25f01a6Soliver@schinagl.nl /* 3c25f01a6Soliver@schinagl.nl * (C) Copyright 2016 4c25f01a6Soliver@schinagl.nl * Olliver Schinagl <oliver@schinagl.nl> 5c25f01a6Soliver@schinagl.nl */ 6c25f01a6Soliver@schinagl.nl 7c25f01a6Soliver@schinagl.nl #include <ctype.h> 8d2bf1152SMasahiro Yamada #include <stdbool.h> 9c25f01a6Soliver@schinagl.nl #include <stdint.h> 10c25f01a6Soliver@schinagl.nl #include <stdio.h> 11c25f01a6Soliver@schinagl.nl #include <stdlib.h> 12c25f01a6Soliver@schinagl.nl #include <string.h> 13c25f01a6Soliver@schinagl.nl #include <u-boot/crc.h> 14c25f01a6Soliver@schinagl.nl 15c25f01a6Soliver@schinagl.nl #define ARP_HLEN 6 /* Length of hardware address */ 16c25f01a6Soliver@schinagl.nl #define ARP_HLEN_ASCII (ARP_HLEN * 2) + (ARP_HLEN - 1) /* with separators */ 17c25f01a6Soliver@schinagl.nl #define ARP_HLEN_LAZY (ARP_HLEN * 2) /* separatorless hardware address length */ 18c25f01a6Soliver@schinagl.nl 19c25f01a6Soliver@schinagl.nl uint8_t nibble_to_hex(const char *nibble, bool lo) 20c25f01a6Soliver@schinagl.nl { 21c25f01a6Soliver@schinagl.nl return (strtol(nibble, NULL, 16) << (lo ? 0 : 4)) & (lo ? 0x0f : 0xf0); 22c25f01a6Soliver@schinagl.nl } 23c25f01a6Soliver@schinagl.nl 24c25f01a6Soliver@schinagl.nl int process_mac(const char *mac_address) 25c25f01a6Soliver@schinagl.nl { 26c25f01a6Soliver@schinagl.nl uint8_t ethaddr[ARP_HLEN + 1] = { 0x00 }; 27c25f01a6Soliver@schinagl.nl uint_fast8_t i = 0; 28c25f01a6Soliver@schinagl.nl 29c25f01a6Soliver@schinagl.nl while (*mac_address != '\0') { 30c25f01a6Soliver@schinagl.nl char nibble[2] = { 0x00, '\n' }; /* for strtol */ 31c25f01a6Soliver@schinagl.nl 32c25f01a6Soliver@schinagl.nl nibble[0] = *mac_address++; 33c25f01a6Soliver@schinagl.nl if (isxdigit(nibble[0])) { 34c25f01a6Soliver@schinagl.nl if (isupper(nibble[0])) 35c25f01a6Soliver@schinagl.nl nibble[0] = tolower(nibble[0]); 36c25f01a6Soliver@schinagl.nl ethaddr[i >> 1] |= nibble_to_hex(nibble, (i % 2) != 0); 37c25f01a6Soliver@schinagl.nl i++; 38c25f01a6Soliver@schinagl.nl } 39c25f01a6Soliver@schinagl.nl } 40c25f01a6Soliver@schinagl.nl 41c25f01a6Soliver@schinagl.nl for (i = 0; i < ARP_HLEN; i++) 42c25f01a6Soliver@schinagl.nl printf("%.2x", ethaddr[i]); 43c25f01a6Soliver@schinagl.nl printf("%.2x\n", crc8(0, ethaddr, ARP_HLEN)); 44c25f01a6Soliver@schinagl.nl 45c25f01a6Soliver@schinagl.nl return 0; 46c25f01a6Soliver@schinagl.nl } 47c25f01a6Soliver@schinagl.nl 48c25f01a6Soliver@schinagl.nl void print_usage(char *cmdname) 49c25f01a6Soliver@schinagl.nl { 50c25f01a6Soliver@schinagl.nl printf("Usage: %s <mac_address>\n", cmdname); 51c25f01a6Soliver@schinagl.nl puts("<mac_address> may be with or without separators."); 52c25f01a6Soliver@schinagl.nl puts("Valid seperators are ':' and '-'."); 53c25f01a6Soliver@schinagl.nl puts("<mac_address> digits are in base 16.\n"); 54c25f01a6Soliver@schinagl.nl } 55c25f01a6Soliver@schinagl.nl 56c25f01a6Soliver@schinagl.nl int main(int argc, char *argv[]) 57c25f01a6Soliver@schinagl.nl { 58c25f01a6Soliver@schinagl.nl if (argc < 2) { 59c25f01a6Soliver@schinagl.nl print_usage(argv[0]); 60c25f01a6Soliver@schinagl.nl return 1; 61c25f01a6Soliver@schinagl.nl } 62c25f01a6Soliver@schinagl.nl 63c25f01a6Soliver@schinagl.nl if (!((strlen(argv[1]) == ARP_HLEN_ASCII) || (strlen(argv[1]) == ARP_HLEN_LAZY))) { 64c25f01a6Soliver@schinagl.nl puts("The MAC address is not valid.\n"); 65c25f01a6Soliver@schinagl.nl print_usage(argv[0]); 66c25f01a6Soliver@schinagl.nl return 1; 67c25f01a6Soliver@schinagl.nl } 68c25f01a6Soliver@schinagl.nl 69c25f01a6Soliver@schinagl.nl if (process_mac(argv[1])) { 70c25f01a6Soliver@schinagl.nl puts("Failed to calculate the MAC's checksum."); 71c25f01a6Soliver@schinagl.nl return 1; 72c25f01a6Soliver@schinagl.nl } 73c25f01a6Soliver@schinagl.nl 74c25f01a6Soliver@schinagl.nl return 0; 75c25f01a6Soliver@schinagl.nl } 76