1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
|
/******************************************************************************
* Copyright (c) 2004, 2008 IBM Corporation
* All rights reserved.
* This program and the accompanying materials
* are made available under the terms of the BSD License
* which accompanies this distribution, and is available at
* http://www.opensource.org/licenses/bsd-license.php
*
* Contributors:
* IBM Corporation - initial implementation
*****************************************************************************/
#include <netlib/ipv4.h>
#include <netlib/dhcp.h>
#include <netlib/ethernet.h>
#include <sys/socket.h>
#include <string.h>
#include <stdio.h>
#include <stdlib.h>
#include <time.h>
#include <netapps/args.h>
#include "netapps.h"
struct ping_args {
union {
char string[4];
unsigned int integer;
} server_ip;
union {
char string[4];
unsigned int integer;
} client_ip;
union {
char string[4];
unsigned int integer;
} gateway_ip;
unsigned int timeout;
};
static void
usage(void)
{
printf
("\nping device-path:[device-args,]server-ip,[client-ip],[gateway-ip][,timeout]\n");
}
static int
parse_args(const char *args, struct ping_args *ping_args)
{
unsigned int argc = get_args_count(args);
char buf[64];
ping_args->timeout = 10;
if (argc == 0)
/* at least server-ip has to be specified */
return -1;
if (argc == 1) {
/* probably only server ip is specified */
argncpy(args, 0, buf, 64);
if (!strtoip(buf, ping_args->server_ip.string))
return -1;
return 0;
}
/* get first option from list */
argncpy(args, 0, buf, 64);
if (!strtoip(buf, ping_args->server_ip.string)) {
/* it is not an IP address
* therefore it has to be device-args
* device-args are not supported and just ignored */
args = get_arg_ptr(args, 1);
argc--;
}
argncpy(args, 0, buf, 64);
if (!strtoip(buf, ping_args->server_ip.string)) {
/* this should have been the server IP address */
return -1;
} else {
args = get_arg_ptr(args, 1);
if (!--argc)
return 0;
}
argncpy(args, 0, buf, 64);
if (!strtoip(buf, ping_args->client_ip.string)) {
/* this should have been the client (our) IP address */
return -1;
} else {
args = get_arg_ptr(args, 1);
if (!--argc)
return 0;
}
argncpy(args, 0, buf, 64);
if (!strtoip(buf, ping_args->gateway_ip.string)) {
/* this should have been the gateway IP address */
return -1;
} else {
args = get_arg_ptr(args, 1);
if (!--argc)
return 0;
}
argncpy(args, 0, buf, 64);
ping_args->timeout = strtol(args, 0, 10);
return 0;
}
int
ping(int argc, char *argv[])
{
short arp_failed = 0;
filename_ip_t fn_ip;
int fd_device;
struct ping_args ping_args;
uint8_t own_mac[6];
memset(&ping_args, 0, sizeof(struct ping_args));
if (argc == 2) {
if (parse_args(argv[1], &ping_args)) {
usage();
return -1;
}
} else {
usage();
return -1;
}
memset(&fn_ip, 0, sizeof(filename_ip_t));
/* Get mac_addr from device */
printf("\n Reading MAC address from device: ");
fd_device = socket(0, 0, 0, (char *) own_mac);
if (fd_device == -1) {
printf("\nE3000: Could not read MAC address\n");
return -100;
} else if (fd_device == -2) {
printf("\nE3006: Could not initialize network device\n");
return -101;
}
fn_ip.fd = fd_device;
printf("%02x:%02x:%02x:%02x:%02x:%02x\n",
own_mac[0], own_mac[1], own_mac[2],
own_mac[3], own_mac[4], own_mac[5]);
// init ethernet layer
set_mac_address(own_mac);
// identify the BOOTP/DHCP server via broadcasts
// don't do this, when using DHCP !!!
// fn_ip.server_ip = 0xFFFFFFFF;
// memset(fn_ip.server_mac, 0xff, 6);
if (!ping_args.client_ip.integer) {
/* Get ip address for our mac address */
printf(" Requesting IP address via DHCP: ");
arp_failed = dhcp(0, &fn_ip, 30, F_IPV4);
if (arp_failed == -1) {
printf("\n DHCP: Could not get ip address\n");
return -1;
}
} else {
memcpy(&fn_ip.own_ip, &ping_args.client_ip.integer, 4);
arp_failed = 1;
printf(" Own IP address: ");
}
// reinit network stack
set_ipv4_address(fn_ip.own_ip);
printf("%d.%d.%d.%d\n",
((fn_ip.own_ip >> 24) & 0xFF), ((fn_ip.own_ip >> 16) & 0xFF),
((fn_ip.own_ip >> 8) & 0xFF), (fn_ip.own_ip & 0xFF));
memcpy(&fn_ip.server_ip, &ping_args.server_ip.integer, 4);
printf(" Ping to %d.%d.%d.%d ", ((fn_ip.server_ip >> 24) & 0xFF),
((fn_ip.server_ip >> 16) & 0xFF),
((fn_ip.server_ip >> 8) & 0xFF), (fn_ip.server_ip & 0xFF));
ping_ipv4(fd_device, fn_ip.server_ip);
set_timer(TICKS_SEC / 10 * ping_args.timeout);
while(get_timer() > 0) {
receive_ether(fd_device);
if(pong_ipv4() == 0) {
printf("success\n");
return 0;
}
}
printf("failed\n");
return -1;
}
|
