1 /*-
2  *   BSD LICENSE
3  *
4  *   Copyright(c) 2010-2014 Intel Corporation. All rights reserved.
5  *   All rights reserved.
6  *
7  *   Redistribution and use in source and binary forms, with or without
8  *   modification, are permitted provided that the following conditions
9  *   are met:
10  *
11  *     * Redistributions of source code must retain the above copyright
12  *       notice, this list of conditions and the following disclaimer.
13  *     * Redistributions in binary form must reproduce the above copyright
14  *       notice, this list of conditions and the following disclaimer in
15  *       the documentation and/or other materials provided with the
16  *       distribution.
17  *     * Neither the name of Intel Corporation nor the names of its
18  *       contributors may be used to endorse or promote products derived
19  *       from this software without specific prior written permission.
20  *
21  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
24  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
25  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
26  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
27  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
28  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
29  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
30  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
31  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
32  */
33 
34 /*
35  * Copyright (c) 2009, Olivier MATZ <[email protected]>
36  * All rights reserved.
37  * Redistribution and use in source and binary forms, with or without
38  * modification, are permitted provided that the following conditions are met:
39  *
40  *     * Redistributions of source code must retain the above copyright
41  *       notice, this list of conditions and the following disclaimer.
42  *     * Redistributions in binary form must reproduce the above copyright
43  *       notice, this list of conditions and the following disclaimer in the
44  *       documentation and/or other materials provided with the distribution.
45  *     * Neither the name of the University of California, Berkeley nor the
46  *       names of its contributors may be used to endorse or promote products
47  *       derived from this software without specific prior written permission.
48  *
49  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND ANY
50  * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
51  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
52  * DISCLAIMED. IN NO EVENT SHALL THE REGENTS AND CONTRIBUTORS BE LIABLE FOR ANY
53  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
54  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
55  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
56  * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
57  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
58  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
59  */
60 
61 #include <stdio.h>
62 #include <stdlib.h>
63 #include <stdarg.h>
64 #include <errno.h>
65 #include <inttypes.h>
66 #include <ctype.h>
67 #include <string.h>
68 #include <sys/types.h>
69 #include <net/ethernet.h>
70 
71 #include <rte_string_fns.h>
72 
73 #include "cmdline_parse.h"
74 #include "cmdline_parse_etheraddr.h"
75 
76 struct cmdline_token_ops cmdline_token_etheraddr_ops = {
77 	.parse = cmdline_parse_etheraddr,
78 	.complete_get_nb = NULL,
79 	.complete_get_elt = NULL,
80 	.get_help = cmdline_get_help_etheraddr,
81 };
82 
83 /* the format can be either XX:XX:XX:XX:XX:XX or XXXX:XXXX:XXXX */
84 #define ETHER_ADDRSTRLENLONG 18
85 #define ETHER_ADDRSTRLENSHORT 15
86 
87 #ifdef __linux__
88 #define ea_oct ether_addr_octet
89 #else
90 #define ea_oct octet
91 #endif
92 
93 
94 static struct ether_addr *
95 my_ether_aton(const char *a)
96 {
97 	int i;
98 	char *end;
99 	unsigned long o[ETHER_ADDR_LEN];
100 	static struct ether_addr ether_addr;
101 
102 	i = 0;
103 	do {
104 		errno = 0;
105 		o[i] = strtoul(a, &end, 16);
106 		if (errno != 0 || end == a || (end[0] != ':' && end[0] != 0))
107 			return NULL;
108 		a = end + 1;
109 	} while (++i != sizeof (o) / sizeof (o[0]) && end[0] != 0);
110 
111 	/* Junk at the end of line */
112 	if (end[0] != 0)
113 		return NULL;
114 
115 	/* Support the format XX:XX:XX:XX:XX:XX */
116 	if (i == ETHER_ADDR_LEN) {
117 		while (i-- != 0) {
118 			if (o[i] > UINT8_MAX)
119 				return NULL;
120 			ether_addr.ea_oct[i] = (uint8_t)o[i];
121 		}
122 	/* Support the format XXXX:XXXX:XXXX */
123 	} else if (i == ETHER_ADDR_LEN / 2) {
124 		while (i-- != 0) {
125 			if (o[i] > UINT16_MAX)
126 				return NULL;
127 			ether_addr.ea_oct[i * 2] = (uint8_t)(o[i] >> 8);
128 			ether_addr.ea_oct[i * 2 + 1] = (uint8_t)(o[i] & 0xff);
129 		}
130 	/* unknown format */
131 	} else
132 		return NULL;
133 
134 	return (struct ether_addr *)&ether_addr;
135 }
136 
137 int
138 cmdline_parse_etheraddr(__attribute__((unused)) cmdline_parse_token_hdr_t *tk,
139 	const char *buf, void *res, unsigned ressize)
140 {
141 	unsigned int token_len = 0;
142 	char ether_str[ETHER_ADDRSTRLENLONG+1];
143 	struct ether_addr *tmp;
144 
145 	if (res && ressize < sizeof(struct ether_addr))
146 		return -1;
147 
148 	if (!buf || ! *buf)
149 		return -1;
150 
151 	while (!cmdline_isendoftoken(buf[token_len]))
152 		token_len++;
153 
154 	/* if token doesn't match possible string lengths... */
155 	if ((token_len != ETHER_ADDRSTRLENLONG - 1) &&
156 			(token_len != ETHER_ADDRSTRLENSHORT - 1))
157 		return -1;
158 
159 	snprintf(ether_str, token_len+1, "%s", buf);
160 
161 	tmp = my_ether_aton(ether_str);
162 	if (tmp == NULL)
163 		return -1;
164 	if (res)
165 		memcpy(res, tmp, sizeof(struct ether_addr));
166 	return token_len;
167 }
168 
169 int
170 cmdline_get_help_etheraddr(__attribute__((unused)) cmdline_parse_token_hdr_t *tk,
171 			       char *dstbuf, unsigned int size)
172 {
173 	int ret;
174 
175 	ret = snprintf(dstbuf, size, "Ethernet address");
176 	if (ret < 0)
177 		return -1;
178 	return 0;
179 }
180