[457] | 1 | /*
|
---|
| 2 | * Copyright (c) 2001-2003 Swedish Institute of Computer Science.
|
---|
| 3 | * All rights reserved.
|
---|
| 4 | *
|
---|
| 5 | * Redistribution and use in source and binary forms, with or without modification,
|
---|
| 6 | * are permitted provided that the following conditions are met:
|
---|
| 7 | *
|
---|
| 8 | * 1. Redistributions of source code must retain the above copyright notice,
|
---|
| 9 | * this list of conditions and the following disclaimer.
|
---|
| 10 | * 2. Redistributions in binary form must reproduce the above copyright notice,
|
---|
| 11 | * this list of conditions and the following disclaimer in the documentation
|
---|
| 12 | * and/or other materials provided with the distribution.
|
---|
| 13 | * 3. The name of the author may not be used to endorse or promote products
|
---|
| 14 | * derived from this software without specific prior written permission.
|
---|
| 15 | *
|
---|
| 16 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
|
---|
| 17 | * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
---|
| 18 | * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT
|
---|
| 19 | * SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
---|
| 20 | * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
|
---|
| 21 | * OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
---|
| 22 | * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
---|
| 23 | * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
|
---|
| 24 | * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
|
---|
| 25 | * OF SUCH DAMAGE.
|
---|
| 26 | *
|
---|
| 27 | * This file is part of the lwIP TCP/IP stack.
|
---|
| 28 | *
|
---|
| 29 | * Author: Adam Dunkels <adam@sics.se>
|
---|
| 30 | *
|
---|
| 31 | */
|
---|
| 32 |
|
---|
| 33 | #include "shell.h"
|
---|
| 34 |
|
---|
| 35 | #include "lwip/opt.h"
|
---|
| 36 |
|
---|
| 37 | #if LWIP_NETCONN && LWIP_TCP
|
---|
| 38 |
|
---|
| 39 | #include <string.h>
|
---|
| 40 | #include <stdio.h>
|
---|
| 41 |
|
---|
| 42 | #include "lwip/mem.h"
|
---|
| 43 | #include "lwip/debug.h"
|
---|
| 44 | #include "lwip/def.h"
|
---|
| 45 | #include "lwip/api.h"
|
---|
| 46 | #include "lwip/stats.h"
|
---|
| 47 |
|
---|
| 48 | #if LWIP_SOCKET
|
---|
| 49 | #include "lwip/errno.h"
|
---|
| 50 | #include "lwip/if_api.h"
|
---|
| 51 | #endif
|
---|
| 52 |
|
---|
| 53 | #if 1 /* WIN32 TOPPERS */
|
---|
| 54 | #define NEWLINE "\r\n"
|
---|
| 55 | #else /* WIN32 */
|
---|
| 56 | #define NEWLINE "\n"
|
---|
| 57 | #endif /* WIN32 */
|
---|
| 58 |
|
---|
| 59 | /** Define this to 1 if you want to echo back all received characters
|
---|
| 60 | * (e.g. so they are displayed on a remote telnet)
|
---|
| 61 | */
|
---|
| 62 | #ifndef SHELL_ECHO
|
---|
| 63 | #define SHELL_ECHO 0
|
---|
| 64 | #endif
|
---|
| 65 |
|
---|
| 66 | #define BUFSIZE 1024
|
---|
| 67 | static unsigned char buffer[BUFSIZE];
|
---|
| 68 |
|
---|
| 69 | struct command {
|
---|
| 70 | struct netconn *conn;
|
---|
| 71 | s8_t (* exec)(struct command *);
|
---|
| 72 | u8_t nargs;
|
---|
| 73 | char *args[10];
|
---|
| 74 | };
|
---|
| 75 |
|
---|
| 76 | #include <stdio.h>
|
---|
| 77 | #include <stdlib.h>
|
---|
| 78 | #include <limits.h>
|
---|
| 79 |
|
---|
| 80 | /*
|
---|
| 81 | * TELNET state
|
---|
| 82 | */
|
---|
| 83 | #define TELNET_STATE_DATA 0
|
---|
| 84 | #define TELNET_STATE_CR 1
|
---|
| 85 | #define TELNET_STATE_IAC 2
|
---|
| 86 | #define TELNET_STATE_WILL 3
|
---|
| 87 | #define TELNET_STATE_WONT 4
|
---|
| 88 | #define TELNET_STATE_DO 5
|
---|
| 89 | #define TELNET_STATE_DONT 6
|
---|
| 90 | #define TELNET_STATE_SB 7
|
---|
| 91 | #define TELNET_STATE_SE 8
|
---|
| 92 |
|
---|
| 93 | /*
|
---|
| 94 | * TELNET control command
|
---|
| 95 | */
|
---|
| 96 | #define TELNET_SE 240
|
---|
| 97 | #define TELNET_NOP 241
|
---|
| 98 | #define TELNET_DM 242
|
---|
| 99 | #define TELNET_BRK 243
|
---|
| 100 | #define TELNET_IP 244
|
---|
| 101 | #define TELNET_AO 245
|
---|
| 102 | #define TELNET_AYT 246
|
---|
| 103 | #define TELNET_EC 247
|
---|
| 104 | #define TELNET_EL 248
|
---|
| 105 | #define TELNET_GA 249
|
---|
| 106 | #define TELNET_SB 250
|
---|
| 107 | #define TELNET_WILL 251
|
---|
| 108 | #define TELNET_WONT 252
|
---|
| 109 | #define TELNET_DO 253
|
---|
| 110 | #define TELNET_DONT 254
|
---|
| 111 | #define TELNET_IAC 255
|
---|
| 112 |
|
---|
| 113 | #define ESUCCESS 0
|
---|
| 114 | #define ESYNTAX -1
|
---|
| 115 | #define ETOOFEW -2
|
---|
| 116 | #define ETOOMANY -3
|
---|
| 117 | #define ECLOSED -4
|
---|
| 118 |
|
---|
| 119 | #define NCONNS 10
|
---|
| 120 | static struct netconn *conns[NCONNS];
|
---|
| 121 |
|
---|
| 122 | /* help_msg is split into 3 strings to prevent exceeding the C89 maximum length of 509 per string */
|
---|
| 123 | static char help_msg1[] = "Available commands:"NEWLINE"\
|
---|
| 124 | open [IP address] [TCP port]: opens a TCP connection to the specified address."NEWLINE"\
|
---|
| 125 | lstn [TCP port]: sets up a server on the specified port."NEWLINE"\
|
---|
| 126 | acpt [connection #]: waits for an incoming connection request."NEWLINE"\
|
---|
| 127 | send [connection #] [message]: sends a message on a TCP connection."NEWLINE"\
|
---|
| 128 | udpc [local UDP port] [IP address] [remote port]: opens a UDP \"connection\"."NEWLINE"\
|
---|
| 129 | udpl [local UDP port] [IP address] [remote port]: opens a UDP-Lite \"connection\"."NEWLINE"";
|
---|
| 130 | static char help_msg2[] = "udpn [local UDP port] [IP address] [remote port]: opens a UDP \"connection\" without checksums."NEWLINE"\
|
---|
| 131 | udpb [local port] [remote port]: opens a UDP broadcast \"connection\"."NEWLINE"\
|
---|
| 132 | usnd [connection #] [message]: sends a message on a UDP connection."NEWLINE"\
|
---|
| 133 | recv [connection #]: recieves data on a TCP or UDP connection."NEWLINE"\
|
---|
| 134 | clos [connection #]: closes a TCP or UDP connection."NEWLINE"\
|
---|
| 135 | stat: prints out lwIP statistics."NEWLINE"\
|
---|
| 136 | idxtoname [index]: outputs interface name from index."NEWLINE"\
|
---|
| 137 | nametoidx [name]: outputs interface index from name."NEWLINE;
|
---|
| 138 | static char help_msg3[] =
|
---|
| 139 | "gethostnm [name]: outputs IP address of host."NEWLINE"\
|
---|
| 140 | quit: quits"NEWLINE"";
|
---|
| 141 |
|
---|
| 142 | #if LWIP_STATS
|
---|
| 143 | static char padding_10spaces[] = " ";
|
---|
| 144 |
|
---|
| 145 | #define PROTOCOL_STATS (LINK_STATS && ETHARP_STATS && IPFRAG_STATS && IP_STATS && ICMP_STATS && UDP_STATS && TCP_STATS)
|
---|
| 146 |
|
---|
| 147 | #if PROTOCOL_STATS
|
---|
| 148 | static const char* shell_stat_proto_names[] = {
|
---|
| 149 | #if LINK_STATS
|
---|
| 150 | "LINK ",
|
---|
| 151 | #endif
|
---|
| 152 | #if ETHARP_STATS
|
---|
| 153 | "ETHARP ",
|
---|
| 154 | #endif
|
---|
| 155 | #if IPFRAG_STATS
|
---|
| 156 | "IP_FRAG ",
|
---|
| 157 | #endif
|
---|
| 158 | #if IP_STATS
|
---|
| 159 | "IP ",
|
---|
| 160 | #endif
|
---|
| 161 | #if ICMP_STATS
|
---|
| 162 | "ICMP ",
|
---|
| 163 | #endif
|
---|
| 164 | #if UDP_STATS
|
---|
| 165 | "UDP ",
|
---|
| 166 | #endif
|
---|
| 167 | #if TCP_STATS
|
---|
| 168 | "TCP ",
|
---|
| 169 | #endif
|
---|
| 170 | "last"
|
---|
| 171 | };
|
---|
| 172 |
|
---|
| 173 | static struct stats_proto* shell_stat_proto_stats[] = {
|
---|
| 174 | #if LINK_STATS
|
---|
| 175 | &lwip_stats.link,
|
---|
| 176 | #endif
|
---|
| 177 | #if ETHARP_STATS
|
---|
| 178 | &lwip_stats.etharp,
|
---|
| 179 | #endif
|
---|
| 180 | #if IPFRAG_STATS
|
---|
| 181 | &lwip_stats.ip_frag,
|
---|
| 182 | #endif
|
---|
| 183 | #if IP_STATS
|
---|
| 184 | &lwip_stats.ip,
|
---|
| 185 | #endif
|
---|
| 186 | #if ICMP_STATS
|
---|
| 187 | &lwip_stats.icmp,
|
---|
| 188 | #endif
|
---|
| 189 | #if UDP_STATS
|
---|
| 190 | &lwip_stats.udp,
|
---|
| 191 | #endif
|
---|
| 192 | #if TCP_STATS
|
---|
| 193 | &lwip_stats.tcp,
|
---|
| 194 | #endif
|
---|
| 195 | };
|
---|
| 196 | const size_t num_protostats = sizeof(shell_stat_proto_stats)/sizeof(struct stats_proto*);
|
---|
| 197 |
|
---|
| 198 | static const char *stat_msgs_proto[] = {
|
---|
| 199 | " * transmitted ",
|
---|
| 200 | " * received ",
|
---|
| 201 | " forwarded ",
|
---|
| 202 | " * dropped ",
|
---|
| 203 | " * checksum errors ",
|
---|
| 204 | " * length errors ",
|
---|
| 205 | " * memory errors ",
|
---|
| 206 | " routing errors ",
|
---|
| 207 | " protocol errors ",
|
---|
| 208 | " option errors ",
|
---|
| 209 | " * misc errors ",
|
---|
| 210 | " cache hits "
|
---|
| 211 | };
|
---|
| 212 | #endif /* PROTOCOL_STATS */
|
---|
| 213 | #endif /* LWIP_STATS */
|
---|
| 214 |
|
---|
| 215 | /*-----------------------------------------------------------------------------------*/
|
---|
| 216 | static void
|
---|
| 217 | sendstr(const char *str, struct netconn *conn)
|
---|
| 218 | {
|
---|
| 219 | netconn_write(conn, (const void *)str, strlen(str), NETCONN_NOCOPY);
|
---|
| 220 | }
|
---|
| 221 | /*-----------------------------------------------------------------------------------*/
|
---|
| 222 | static s8_t
|
---|
| 223 | com_open(struct command *com)
|
---|
| 224 | {
|
---|
| 225 | ip_addr_t ipaddr;
|
---|
| 226 | u16_t port;
|
---|
| 227 | int i;
|
---|
| 228 | err_t err;
|
---|
| 229 | long tmp;
|
---|
| 230 |
|
---|
| 231 | if (ipaddr_aton(com->args[0], &ipaddr) == -1) {
|
---|
| 232 | sendstr(strerror(errno), com->conn);
|
---|
| 233 | return ESYNTAX;
|
---|
| 234 | }
|
---|
| 235 | tmp = strtol(com->args[1], NULL, 10);
|
---|
| 236 | if((tmp < 0) || (tmp > 0xffff)) {
|
---|
| 237 | sendstr("Invalid port number."NEWLINE, com->conn);
|
---|
| 238 | return ESUCCESS;
|
---|
| 239 | }
|
---|
| 240 | port = (u16_t)tmp;
|
---|
| 241 |
|
---|
| 242 | /* Find the first unused connection in conns. */
|
---|
| 243 | for(i = 0; i < NCONNS && conns[i] != NULL; i++);
|
---|
| 244 |
|
---|
| 245 | if (i == NCONNS) {
|
---|
| 246 | sendstr("No more connections available, sorry."NEWLINE, com->conn);
|
---|
| 247 | return ESUCCESS;
|
---|
| 248 | }
|
---|
| 249 |
|
---|
| 250 | sendstr("Opening connection to ", com->conn);
|
---|
| 251 | netconn_write(com->conn, com->args[0], strlen(com->args[0]), NETCONN_COPY);
|
---|
| 252 | sendstr(":", com->conn);
|
---|
| 253 | netconn_write(com->conn, com->args[1], strlen(com->args[1]), NETCONN_COPY);
|
---|
| 254 | sendstr(NEWLINE, com->conn);
|
---|
| 255 |
|
---|
| 256 | conns[i] = netconn_new(NETCONN_TCP);
|
---|
| 257 | if (conns[i] == NULL) {
|
---|
| 258 | sendstr("Could not create connection identifier (out of memory)."NEWLINE, com->conn);
|
---|
| 259 | return ESUCCESS;
|
---|
| 260 | }
|
---|
| 261 | err = netconn_connect(conns[i], &ipaddr, port);
|
---|
| 262 | if (err != ERR_OK) {
|
---|
| 263 | fprintf(stderr, "error %s"NEWLINE, lwip_strerr(err));
|
---|
| 264 | sendstr("Could not connect to remote host: ", com->conn);
|
---|
| 265 | #ifdef LWIP_DEBUG
|
---|
| 266 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 267 | #else
|
---|
| 268 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 269 | #endif /* LWIP_DEBUG */
|
---|
| 270 | sendstr(NEWLINE, com->conn);
|
---|
| 271 | netconn_delete(conns[i]);
|
---|
| 272 | conns[i] = NULL;
|
---|
| 273 | return ESUCCESS;
|
---|
| 274 | }
|
---|
| 275 |
|
---|
| 276 | sendstr("Opened connection, connection identifier is ", com->conn);
|
---|
| 277 | snprintf((char *)buffer, sizeof(buffer), "%d"NEWLINE, i);
|
---|
| 278 | netconn_write(com->conn, buffer, strlen((const char *)buffer), NETCONN_COPY);
|
---|
| 279 |
|
---|
| 280 | return ESUCCESS;
|
---|
| 281 | }
|
---|
| 282 | /*-----------------------------------------------------------------------------------*/
|
---|
| 283 | static s8_t
|
---|
| 284 | com_lstn(struct command *com)
|
---|
| 285 | {
|
---|
| 286 | u16_t port;
|
---|
| 287 | int i;
|
---|
| 288 | err_t err;
|
---|
| 289 | long tmp;
|
---|
| 290 |
|
---|
| 291 | tmp = strtol(com->args[0], NULL, 10);
|
---|
| 292 | if((tmp < 0) || (tmp > 0xffff)) {
|
---|
| 293 | sendstr("Invalid port number."NEWLINE, com->conn);
|
---|
| 294 | return ESUCCESS;
|
---|
| 295 | }
|
---|
| 296 | port = (u16_t)tmp;
|
---|
| 297 |
|
---|
| 298 | /* Find the first unused connection in conns. */
|
---|
| 299 | for(i = 0; i < NCONNS && conns[i] != NULL; i++);
|
---|
| 300 |
|
---|
| 301 | if (i == NCONNS) {
|
---|
| 302 | sendstr("No more connections available, sorry."NEWLINE, com->conn);
|
---|
| 303 | return ESUCCESS;
|
---|
| 304 | }
|
---|
| 305 |
|
---|
| 306 | sendstr("Opening a listening connection on port ", com->conn);
|
---|
| 307 | netconn_write(com->conn, com->args[0], strlen(com->args[0]), NETCONN_COPY);
|
---|
| 308 | sendstr(NEWLINE, com->conn);
|
---|
| 309 |
|
---|
| 310 | conns[i] = netconn_new(NETCONN_TCP);
|
---|
| 311 | if (conns[i] == NULL) {
|
---|
| 312 | sendstr("Could not create connection identifier (out of memory)."NEWLINE, com->conn);
|
---|
| 313 | return ESUCCESS;
|
---|
| 314 | }
|
---|
| 315 |
|
---|
| 316 | err = netconn_bind(conns[i], IP_ADDR_ANY, port);
|
---|
| 317 | if (err != ERR_OK) {
|
---|
| 318 | netconn_delete(conns[i]);
|
---|
| 319 | conns[i] = NULL;
|
---|
| 320 | sendstr("Could not bind: ", com->conn);
|
---|
| 321 | #ifdef LWIP_DEBUG
|
---|
| 322 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 323 | #else
|
---|
| 324 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 325 | #endif /* LWIP_DEBUG */
|
---|
| 326 | sendstr(NEWLINE, com->conn);
|
---|
| 327 | return ESUCCESS;
|
---|
| 328 | }
|
---|
| 329 |
|
---|
| 330 | err = netconn_listen(conns[i]);
|
---|
| 331 | if (err != ERR_OK) {
|
---|
| 332 | netconn_delete(conns[i]);
|
---|
| 333 | conns[i] = NULL;
|
---|
| 334 | sendstr("Could not listen: ", com->conn);
|
---|
| 335 | #ifdef LWIP_DEBUG
|
---|
| 336 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 337 | #else
|
---|
| 338 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 339 | #endif /* LWIP_DEBUG */
|
---|
| 340 | sendstr(NEWLINE, com->conn);
|
---|
| 341 | return ESUCCESS;
|
---|
| 342 | }
|
---|
| 343 |
|
---|
| 344 | sendstr("Opened connection, connection identifier is ", com->conn);
|
---|
| 345 | snprintf((char *)buffer, sizeof(buffer), "%d"NEWLINE, i);
|
---|
| 346 | netconn_write(com->conn, buffer, strlen((const char *)buffer), NETCONN_COPY);
|
---|
| 347 |
|
---|
| 348 | return ESUCCESS;
|
---|
| 349 | }
|
---|
| 350 | /*-----------------------------------------------------------------------------------*/
|
---|
| 351 | /*-----------------------------------------------------------------------------------*/
|
---|
| 352 | static s8_t
|
---|
| 353 | com_clos(struct command *com)
|
---|
| 354 | {
|
---|
| 355 | int i;
|
---|
| 356 | err_t err;
|
---|
| 357 |
|
---|
| 358 | i = strtol(com->args[0], NULL, 10);
|
---|
| 359 |
|
---|
| 360 | if (i > NCONNS) {
|
---|
| 361 | sendstr("Connection identifier too high."NEWLINE, com->conn);
|
---|
| 362 | return ESUCCESS;
|
---|
| 363 | }
|
---|
| 364 | if (conns[i] == NULL) {
|
---|
| 365 | sendstr("Connection identifier not in use."NEWLINE, com->conn);
|
---|
| 366 | return ESUCCESS;
|
---|
| 367 | }
|
---|
| 368 |
|
---|
| 369 | err = netconn_close(conns[i]);
|
---|
| 370 | if (err != ERR_OK) {
|
---|
| 371 | sendstr("Could not close connection: ", com->conn);
|
---|
| 372 | #ifdef LWIP_DEBUG
|
---|
| 373 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 374 | #else
|
---|
| 375 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 376 | #endif /* LWIP_DEBUG */
|
---|
| 377 | sendstr(NEWLINE, com->conn);
|
---|
| 378 | return ESUCCESS;
|
---|
| 379 | }
|
---|
| 380 |
|
---|
| 381 | sendstr("Connection closed."NEWLINE, com->conn);
|
---|
| 382 | netconn_delete(conns[i]);
|
---|
| 383 | conns[i] = NULL;
|
---|
| 384 | return ESUCCESS;
|
---|
| 385 | }
|
---|
| 386 | /*-----------------------------------------------------------------------------------*/
|
---|
| 387 | static s8_t
|
---|
| 388 | com_acpt(struct command *com)
|
---|
| 389 | {
|
---|
| 390 | int i, j;
|
---|
| 391 | err_t err;
|
---|
| 392 |
|
---|
| 393 | /* Find the first unused connection in conns. */
|
---|
| 394 | for(j = 0; j < NCONNS && conns[j] != NULL; j++);
|
---|
| 395 |
|
---|
| 396 | if (j == NCONNS) {
|
---|
| 397 | sendstr("No more connections available, sorry."NEWLINE, com->conn);
|
---|
| 398 | return ESUCCESS;
|
---|
| 399 | }
|
---|
| 400 |
|
---|
| 401 | i = strtol(com->args[0], NULL, 10);
|
---|
| 402 |
|
---|
| 403 | if (i > NCONNS) {
|
---|
| 404 | sendstr("Connection identifier too high."NEWLINE, com->conn);
|
---|
| 405 | return ESUCCESS;
|
---|
| 406 | }
|
---|
| 407 | if (conns[i] == NULL) {
|
---|
| 408 | sendstr("Connection identifier not in use."NEWLINE, com->conn);
|
---|
| 409 | return ESUCCESS;
|
---|
| 410 | }
|
---|
| 411 |
|
---|
| 412 | err = netconn_accept(conns[i], &conns[j]);
|
---|
| 413 |
|
---|
| 414 | if (err != ERR_OK) {
|
---|
| 415 | sendstr("Could not accept connection: ", com->conn);
|
---|
| 416 | #ifdef LWIP_DEBUG
|
---|
| 417 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 418 | #else
|
---|
| 419 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 420 | #endif /* LWIP_DEBUG */
|
---|
| 421 | sendstr(NEWLINE, com->conn);
|
---|
| 422 | return ESUCCESS;
|
---|
| 423 | }
|
---|
| 424 |
|
---|
| 425 | sendstr("Accepted connection, connection identifier for new connection is ", com->conn);
|
---|
| 426 | snprintf((char *)buffer, sizeof(buffer), "%d"NEWLINE, j);
|
---|
| 427 | netconn_write(com->conn, buffer, strlen((const char *)buffer), NETCONN_COPY);
|
---|
| 428 |
|
---|
| 429 | return ESUCCESS;
|
---|
| 430 | }
|
---|
| 431 | /*-----------------------------------------------------------------------------------*/
|
---|
| 432 | #if LWIP_STATS
|
---|
| 433 | static void
|
---|
| 434 | com_stat_write_mem(struct netconn *conn, struct stats_mem *elem, int i)
|
---|
| 435 | {
|
---|
| 436 | u16_t len;
|
---|
| 437 | char buf[100];
|
---|
| 438 | size_t slen;
|
---|
| 439 |
|
---|
| 440 | #ifdef LWIP_DEBUG
|
---|
| 441 | LWIP_UNUSED_ARG(i);
|
---|
| 442 | slen = strlen(elem->name);
|
---|
| 443 | netconn_write(conn, elem->name, slen, NETCONN_COPY);
|
---|
| 444 | #else /* LWIP_DEBUG */
|
---|
| 445 | len = (u16_t)sprintf(buf, "%d", i);
|
---|
| 446 | slen = strlen(buf);
|
---|
| 447 | netconn_write(conn, buf, slen, NETCONN_COPY);
|
---|
| 448 | #endif /* LWIP_DEBUG */
|
---|
| 449 | if(slen < 10) {
|
---|
| 450 | netconn_write(conn, padding_10spaces, 10-slen, NETCONN_COPY);
|
---|
| 451 | }
|
---|
| 452 |
|
---|
| 453 | len = (u16_t)sprintf(buf, " * available %"MEM_SIZE_F NEWLINE, elem->avail);
|
---|
| 454 | netconn_write(conn, buf, len, NETCONN_COPY);
|
---|
| 455 | len = (u16_t)sprintf(buf, " * used %"MEM_SIZE_F NEWLINE, elem->used);
|
---|
| 456 | netconn_write(conn, buf, len, NETCONN_COPY);
|
---|
| 457 | len = (u16_t)sprintf(buf, " * high water mark %"MEM_SIZE_F NEWLINE, elem->max);
|
---|
| 458 | netconn_write(conn, buf, len, NETCONN_COPY);
|
---|
| 459 | len = (u16_t)sprintf(buf, " * errors %"STAT_COUNTER_F NEWLINE, elem->err);
|
---|
| 460 | netconn_write(conn, buf, len, NETCONN_COPY);
|
---|
| 461 | len = (u16_t)sprintf(buf, " * illegal %"STAT_COUNTER_F NEWLINE, elem->illegal);
|
---|
| 462 | netconn_write(conn, buf, len, NETCONN_COPY);
|
---|
| 463 | }
|
---|
| 464 | static void
|
---|
| 465 | com_stat_write_sys(struct netconn *conn, struct stats_syselem *elem, const char *name)
|
---|
| 466 | {
|
---|
| 467 | u16_t len;
|
---|
| 468 | char buf[100];
|
---|
| 469 | size_t slen = strlen(name);
|
---|
| 470 |
|
---|
| 471 | netconn_write(conn, name, slen, NETCONN_COPY);
|
---|
| 472 | if(slen < 10) {
|
---|
| 473 | netconn_write(conn, padding_10spaces, 10-slen, NETCONN_COPY);
|
---|
| 474 | }
|
---|
| 475 |
|
---|
| 476 | len = (u16_t)sprintf(buf, " * used %"STAT_COUNTER_F NEWLINE, elem->used);
|
---|
| 477 | netconn_write(conn, buf, len, NETCONN_COPY);
|
---|
| 478 | len = (u16_t)sprintf(buf, " * high water mark %"STAT_COUNTER_F NEWLINE, elem->max);
|
---|
| 479 | netconn_write(conn, buf, len, NETCONN_COPY);
|
---|
| 480 | len = (u16_t)sprintf(buf, " * errors %"STAT_COUNTER_F NEWLINE, elem->err);
|
---|
| 481 | netconn_write(conn, buf, len, NETCONN_COPY);
|
---|
| 482 | }
|
---|
| 483 | static s8_t
|
---|
| 484 | com_stat(struct command *com)
|
---|
| 485 | {
|
---|
| 486 | #if PROTOCOL_STATS || MEMP_STATS
|
---|
| 487 | size_t i;
|
---|
| 488 | #endif /* PROTOCOL_STATS || MEMP_STATS */
|
---|
| 489 | #if PROTOCOL_STATS
|
---|
| 490 | size_t k;
|
---|
| 491 | char buf[100];
|
---|
| 492 | u16_t len;
|
---|
| 493 |
|
---|
| 494 | /* protocol stats, @todo: add IGMP */
|
---|
| 495 | for(i = 0; i < num_protostats; i++) {
|
---|
| 496 | size_t s = sizeof(struct stats_proto)/sizeof(STAT_COUNTER);
|
---|
| 497 | STAT_COUNTER *c = &shell_stat_proto_stats[i]->xmit;
|
---|
| 498 | LWIP_ASSERT("stats not in sync", s == sizeof(stat_msgs_proto)/sizeof(char*));
|
---|
| 499 | netconn_write(com->conn, shell_stat_proto_names[i], strlen(shell_stat_proto_names[i]), NETCONN_COPY);
|
---|
| 500 | for(k = 0; k < s; k++) {
|
---|
| 501 | len = (u16_t)sprintf(buf, "%s%"STAT_COUNTER_F NEWLINE, stat_msgs_proto[k], c[k]);
|
---|
| 502 | netconn_write(com->conn, buf, len, NETCONN_COPY);
|
---|
| 503 | }
|
---|
| 504 | }
|
---|
| 505 | #endif /* PROTOCOL_STATS */
|
---|
| 506 | #if MEM_STATS
|
---|
| 507 | com_stat_write_mem(com->conn, &lwip_stats.mem, -1);
|
---|
| 508 | #endif /* MEM_STATS */
|
---|
| 509 | #if MEMP_STATS
|
---|
| 510 | for(i = 0; i < MEMP_MAX; i++) {
|
---|
| 511 | com_stat_write_mem(com->conn, lwip_stats.memp[i], -1);
|
---|
| 512 | }
|
---|
| 513 | #endif /* MEMP_STATS */
|
---|
| 514 | #if SYS_STATS
|
---|
| 515 | com_stat_write_sys(com->conn, &lwip_stats.sys.sem, "SEM ");
|
---|
| 516 | com_stat_write_sys(com->conn, &lwip_stats.sys.mutex, "MUTEX ");
|
---|
| 517 | com_stat_write_sys(com->conn, &lwip_stats.sys.mbox, "MBOX ");
|
---|
| 518 | #endif /* SYS_STATS */
|
---|
| 519 |
|
---|
| 520 | return ESUCCESS;
|
---|
| 521 | }
|
---|
| 522 | #endif
|
---|
| 523 | /*-----------------------------------------------------------------------------------*/
|
---|
| 524 | static s8_t
|
---|
| 525 | com_send(struct command *com)
|
---|
| 526 | {
|
---|
| 527 | int i;
|
---|
| 528 | err_t err;
|
---|
| 529 | size_t len;
|
---|
| 530 |
|
---|
| 531 | i = strtol(com->args[0], NULL, 10);
|
---|
| 532 |
|
---|
| 533 | if (i > NCONNS) {
|
---|
| 534 | sendstr("Connection identifier too high."NEWLINE, com->conn);
|
---|
| 535 | return ESUCCESS;
|
---|
| 536 | }
|
---|
| 537 |
|
---|
| 538 | if (conns[i] == NULL) {
|
---|
| 539 | sendstr("Connection identifier not in use."NEWLINE, com->conn);
|
---|
| 540 | return ESUCCESS;
|
---|
| 541 | }
|
---|
| 542 |
|
---|
| 543 | len = strlen(com->args[1]);
|
---|
| 544 | com->args[1][len] = '\r';
|
---|
| 545 | com->args[1][len + 1] = '\n';
|
---|
| 546 | com->args[1][len + 2] = 0;
|
---|
| 547 |
|
---|
| 548 | err = netconn_write(conns[i], com->args[1], len + 3, NETCONN_COPY);
|
---|
| 549 | if (err != ERR_OK) {
|
---|
| 550 | sendstr("Could not send data: ", com->conn);
|
---|
| 551 | #ifdef LWIP_DEBUG
|
---|
| 552 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 553 | #else
|
---|
| 554 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 555 | #endif /* LWIP_DEBUG */
|
---|
| 556 | sendstr(NEWLINE, com->conn);
|
---|
| 557 | return ESUCCESS;
|
---|
| 558 | }
|
---|
| 559 |
|
---|
| 560 | sendstr("Data enqueued for sending."NEWLINE, com->conn);
|
---|
| 561 | return ESUCCESS;
|
---|
| 562 | }
|
---|
| 563 | /*-----------------------------------------------------------------------------------*/
|
---|
| 564 | static s8_t
|
---|
| 565 | com_recv(struct command *com)
|
---|
| 566 | {
|
---|
| 567 | int i;
|
---|
| 568 | err_t err;
|
---|
| 569 | struct netbuf *buf;
|
---|
| 570 | u16_t len;
|
---|
| 571 |
|
---|
| 572 | i = strtol(com->args[0], NULL, 10);
|
---|
| 573 |
|
---|
| 574 | if (i > NCONNS) {
|
---|
| 575 | sendstr("Connection identifier too high."NEWLINE, com->conn);
|
---|
| 576 | return ESUCCESS;
|
---|
| 577 | }
|
---|
| 578 |
|
---|
| 579 | if (conns[i] == NULL) {
|
---|
| 580 | sendstr("Connection identifier not in use."NEWLINE, com->conn);
|
---|
| 581 | return ESUCCESS;
|
---|
| 582 | }
|
---|
| 583 |
|
---|
| 584 | err = netconn_recv(conns[i], &buf);
|
---|
| 585 | if (err == ERR_OK) {
|
---|
| 586 |
|
---|
| 587 | netbuf_copy(buf, buffer, BUFSIZE);
|
---|
| 588 | len = netbuf_len(buf);
|
---|
| 589 | sendstr("Reading from connection:"NEWLINE, com->conn);
|
---|
| 590 | netconn_write(com->conn, buffer, len, NETCONN_COPY);
|
---|
| 591 | netbuf_delete(buf);
|
---|
| 592 | } else {
|
---|
| 593 | sendstr("EOF."NEWLINE, com->conn);
|
---|
| 594 | }
|
---|
| 595 | err = netconn_err(conns[i]);
|
---|
| 596 | if (err != ERR_OK) {
|
---|
| 597 | sendstr("Could not receive data: ", com->conn);
|
---|
| 598 | #ifdef LWIP_DEBUG
|
---|
| 599 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 600 | #else
|
---|
| 601 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 602 | #endif /* LWIP_DEBUG */
|
---|
| 603 | sendstr(NEWLINE, com->conn);
|
---|
| 604 | return ESUCCESS;
|
---|
| 605 | }
|
---|
| 606 | return ESUCCESS;
|
---|
| 607 | }
|
---|
| 608 | /*-----------------------------------------------------------------------------------*/
|
---|
| 609 | static s8_t
|
---|
| 610 | com_udpc(struct command *com)
|
---|
| 611 | {
|
---|
| 612 | ip_addr_t ipaddr;
|
---|
| 613 | u16_t lport, rport;
|
---|
| 614 | int i;
|
---|
| 615 | err_t err;
|
---|
| 616 | long tmp;
|
---|
| 617 |
|
---|
| 618 | tmp = strtol(com->args[0], NULL, 10);
|
---|
| 619 | if((tmp < 0) || (tmp > 0xffff)) {
|
---|
| 620 | sendstr("Invalid port number."NEWLINE, com->conn);
|
---|
| 621 | return ESUCCESS;
|
---|
| 622 | }
|
---|
| 623 | lport = (u16_t)tmp;
|
---|
| 624 | if (ipaddr_aton(com->args[1], &ipaddr) == -1) {
|
---|
| 625 | sendstr(strerror(errno), com->conn);
|
---|
| 626 | return ESYNTAX;
|
---|
| 627 | }
|
---|
| 628 | tmp = strtol(com->args[2], NULL, 10);
|
---|
| 629 | if((tmp < 0) || (tmp > 0xffff)) {
|
---|
| 630 | sendstr("Invalid port number."NEWLINE, com->conn);
|
---|
| 631 | return ESUCCESS;
|
---|
| 632 | }
|
---|
| 633 | rport = (u16_t)tmp;
|
---|
| 634 |
|
---|
| 635 | /* Find the first unused connection in conns. */
|
---|
| 636 | for(i = 0; i < NCONNS && conns[i] != NULL; i++);
|
---|
| 637 |
|
---|
| 638 | if (i == NCONNS) {
|
---|
| 639 | sendstr("No more connections available, sorry."NEWLINE, com->conn);
|
---|
| 640 | return ESUCCESS;
|
---|
| 641 | }
|
---|
| 642 |
|
---|
| 643 | sendstr("Setting up UDP connection from port ", com->conn);
|
---|
| 644 | netconn_write(com->conn, com->args[0], strlen(com->args[0]), NETCONN_COPY);
|
---|
| 645 | sendstr(" to ", com->conn);
|
---|
| 646 | netconn_write(com->conn, com->args[1], strlen(com->args[1]), NETCONN_COPY);
|
---|
| 647 | sendstr(":", com->conn);
|
---|
| 648 | netconn_write(com->conn, com->args[2], strlen(com->args[2]), NETCONN_COPY);
|
---|
| 649 | sendstr(NEWLINE, com->conn);
|
---|
| 650 |
|
---|
| 651 | conns[i] = netconn_new(NETCONN_UDP);
|
---|
| 652 | if (conns[i] == NULL) {
|
---|
| 653 | sendstr("Could not create connection identifier (out of memory)."NEWLINE, com->conn);
|
---|
| 654 | return ESUCCESS;
|
---|
| 655 | }
|
---|
| 656 |
|
---|
| 657 | err = netconn_connect(conns[i], &ipaddr, rport);
|
---|
| 658 | if (err != ERR_OK) {
|
---|
| 659 | netconn_delete(conns[i]);
|
---|
| 660 | conns[i] = NULL;
|
---|
| 661 | sendstr("Could not connect to remote host: ", com->conn);
|
---|
| 662 | #ifdef LWIP_DEBUG
|
---|
| 663 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 664 | #else
|
---|
| 665 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 666 | #endif /* LWIP_DEBUG */
|
---|
| 667 | sendstr(NEWLINE, com->conn);
|
---|
| 668 | return ESUCCESS;
|
---|
| 669 | }
|
---|
| 670 |
|
---|
| 671 | err = netconn_bind(conns[i], IP_ADDR_ANY, lport);
|
---|
| 672 | if (err != ERR_OK) {
|
---|
| 673 | netconn_delete(conns[i]);
|
---|
| 674 | conns[i] = NULL;
|
---|
| 675 | sendstr("Could not bind: ", com->conn);
|
---|
| 676 | #ifdef LWIP_DEBUG
|
---|
| 677 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 678 | #else
|
---|
| 679 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 680 | #endif /* LWIP_DEBUG */
|
---|
| 681 | sendstr(NEWLINE, com->conn);
|
---|
| 682 | return ESUCCESS;
|
---|
| 683 | }
|
---|
| 684 |
|
---|
| 685 | sendstr("Connection set up, connection identifier is ", com->conn);
|
---|
| 686 | snprintf((char *)buffer, sizeof(buffer), "%d"NEWLINE, i);
|
---|
| 687 | netconn_write(com->conn, buffer, strlen((const char *)buffer), NETCONN_COPY);
|
---|
| 688 |
|
---|
| 689 | return ESUCCESS;
|
---|
| 690 | }
|
---|
| 691 | /*-----------------------------------------------------------------------------------*/
|
---|
| 692 | static s8_t
|
---|
| 693 | com_udpl(struct command *com)
|
---|
| 694 | {
|
---|
| 695 | ip_addr_t ipaddr;
|
---|
| 696 | u16_t lport, rport;
|
---|
| 697 | int i;
|
---|
| 698 | err_t err;
|
---|
| 699 | long tmp;
|
---|
| 700 |
|
---|
| 701 | tmp = strtol(com->args[0], NULL, 10);
|
---|
| 702 | if((tmp < 0) || (tmp > 0xffff)) {
|
---|
| 703 | sendstr("Invalid port number."NEWLINE, com->conn);
|
---|
| 704 | return ESUCCESS;
|
---|
| 705 | }
|
---|
| 706 | lport = (u16_t)tmp;
|
---|
| 707 | if (ipaddr_aton(com->args[1], &ipaddr) == -1) {
|
---|
| 708 | sendstr(strerror(errno), com->conn);
|
---|
| 709 | return ESYNTAX;
|
---|
| 710 | }
|
---|
| 711 | tmp = strtol(com->args[2], NULL, 10);
|
---|
| 712 | if((tmp < 0) || (tmp > 0xffff)) {
|
---|
| 713 | sendstr("Invalid port number."NEWLINE, com->conn);
|
---|
| 714 | return ESUCCESS;
|
---|
| 715 | }
|
---|
| 716 | rport = (u16_t)tmp;
|
---|
| 717 |
|
---|
| 718 | /* Find the first unused connection in conns. */
|
---|
| 719 | for(i = 0; i < NCONNS && conns[i] != NULL; i++);
|
---|
| 720 |
|
---|
| 721 | if (i == NCONNS) {
|
---|
| 722 | sendstr("No more connections available, sorry."NEWLINE, com->conn);
|
---|
| 723 | return ESUCCESS;
|
---|
| 724 | }
|
---|
| 725 |
|
---|
| 726 | sendstr("Setting up UDP-Lite connection from port ", com->conn);
|
---|
| 727 | netconn_write(com->conn, com->args[0], strlen(com->args[0]), NETCONN_COPY);
|
---|
| 728 | sendstr(" to ", com->conn);
|
---|
| 729 | netconn_write(com->conn, com->args[1], strlen(com->args[1]), NETCONN_COPY);
|
---|
| 730 | sendstr(":", com->conn);
|
---|
| 731 | netconn_write(com->conn, com->args[2], strlen(com->args[2]), NETCONN_COPY);
|
---|
| 732 | sendstr(NEWLINE, com->conn);
|
---|
| 733 |
|
---|
| 734 | conns[i] = netconn_new(NETCONN_UDPLITE);
|
---|
| 735 | if (conns[i] == NULL) {
|
---|
| 736 | sendstr("Could not create connection identifier (out of memory)."NEWLINE, com->conn);
|
---|
| 737 | return ESUCCESS;
|
---|
| 738 | }
|
---|
| 739 |
|
---|
| 740 | err = netconn_connect(conns[i], &ipaddr, rport);
|
---|
| 741 | if (err != ERR_OK) {
|
---|
| 742 | netconn_delete(conns[i]);
|
---|
| 743 | conns[i] = NULL;
|
---|
| 744 | sendstr("Could not connect to remote host: ", com->conn);
|
---|
| 745 | #ifdef LWIP_DEBUG
|
---|
| 746 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 747 | #else
|
---|
| 748 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 749 | #endif /* LWIP_DEBUG */
|
---|
| 750 | sendstr(NEWLINE, com->conn);
|
---|
| 751 | return ESUCCESS;
|
---|
| 752 | }
|
---|
| 753 |
|
---|
| 754 | err = netconn_bind(conns[i], IP_ADDR_ANY, lport);
|
---|
| 755 | if (err != ERR_OK) {
|
---|
| 756 | netconn_delete(conns[i]);
|
---|
| 757 | conns[i] = NULL;
|
---|
| 758 | sendstr("Could not bind: ", com->conn);
|
---|
| 759 | #ifdef LWIP_DEBUG
|
---|
| 760 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 761 | #else
|
---|
| 762 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 763 | #endif /* LWIP_DEBUG */
|
---|
| 764 | sendstr(NEWLINE, com->conn);
|
---|
| 765 | return ESUCCESS;
|
---|
| 766 | }
|
---|
| 767 |
|
---|
| 768 | sendstr("Connection set up, connection identifier is ", com->conn);
|
---|
| 769 | snprintf((char *)buffer, sizeof(buffer), "%d"NEWLINE, i);
|
---|
| 770 | netconn_write(com->conn, buffer, strlen((const char *)buffer), NETCONN_COPY);
|
---|
| 771 |
|
---|
| 772 | return ESUCCESS;
|
---|
| 773 | }
|
---|
| 774 | /*-----------------------------------------------------------------------------------*/
|
---|
| 775 | static s8_t
|
---|
| 776 | com_udpn(struct command *com)
|
---|
| 777 | {
|
---|
| 778 | ip_addr_t ipaddr;
|
---|
| 779 | u16_t lport, rport;
|
---|
| 780 | int i;
|
---|
| 781 | err_t err;
|
---|
| 782 | long tmp;
|
---|
| 783 |
|
---|
| 784 | tmp = strtol(com->args[0], NULL, 10);
|
---|
| 785 | if((tmp < 0) || (tmp > 0xffff)) {
|
---|
| 786 | sendstr("Invalid port number."NEWLINE, com->conn);
|
---|
| 787 | return ESUCCESS;
|
---|
| 788 | }
|
---|
| 789 | lport = (u16_t)tmp;
|
---|
| 790 | if (ipaddr_aton(com->args[1], &ipaddr) == -1) {
|
---|
| 791 | sendstr(strerror(errno), com->conn);
|
---|
| 792 | return ESYNTAX;
|
---|
| 793 | }
|
---|
| 794 | tmp = strtol(com->args[2], NULL, 10);
|
---|
| 795 | if((tmp < 0) || (tmp > 0xffff)) {
|
---|
| 796 | sendstr("Invalid port number."NEWLINE, com->conn);
|
---|
| 797 | return ESUCCESS;
|
---|
| 798 | }
|
---|
| 799 | rport = (u16_t)tmp;
|
---|
| 800 |
|
---|
| 801 | /* Find the first unused connection in conns. */
|
---|
| 802 | for(i = 0; i < NCONNS && conns[i] != NULL; i++);
|
---|
| 803 |
|
---|
| 804 | if (i == NCONNS) {
|
---|
| 805 | sendstr("No more connections available, sorry."NEWLINE, com->conn);
|
---|
| 806 | return ESUCCESS;
|
---|
| 807 | }
|
---|
| 808 |
|
---|
| 809 | sendstr("Setting up UDP connection without checksums from port ", com->conn);
|
---|
| 810 | netconn_write(com->conn, com->args[0], strlen(com->args[0]), NETCONN_COPY);
|
---|
| 811 | sendstr(" to ", com->conn);
|
---|
| 812 | netconn_write(com->conn, com->args[1], strlen(com->args[1]), NETCONN_COPY);
|
---|
| 813 | sendstr(":", com->conn);
|
---|
| 814 | netconn_write(com->conn, com->args[2], strlen(com->args[2]), NETCONN_COPY);
|
---|
| 815 | sendstr(NEWLINE, com->conn);
|
---|
| 816 |
|
---|
| 817 | conns[i] = netconn_new(NETCONN_UDPNOCHKSUM);
|
---|
| 818 | if (conns[i] == NULL) {
|
---|
| 819 | sendstr("Could not create connection identifier (out of memory)."NEWLINE, com->conn);
|
---|
| 820 | return ESUCCESS;
|
---|
| 821 | }
|
---|
| 822 |
|
---|
| 823 | err = netconn_connect(conns[i], &ipaddr, rport);
|
---|
| 824 | if (err != ERR_OK) {
|
---|
| 825 | netconn_delete(conns[i]);
|
---|
| 826 | conns[i] = NULL;
|
---|
| 827 | sendstr("Could not connect to remote host: ", com->conn);
|
---|
| 828 | #ifdef LWIP_DEBUG
|
---|
| 829 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 830 | #else
|
---|
| 831 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 832 | #endif /* LWIP_DEBUG */
|
---|
| 833 | sendstr(NEWLINE, com->conn);
|
---|
| 834 | return ESUCCESS;
|
---|
| 835 | }
|
---|
| 836 |
|
---|
| 837 | err = netconn_bind(conns[i], IP_ADDR_ANY, lport);
|
---|
| 838 | if (err != ERR_OK) {
|
---|
| 839 | netconn_delete(conns[i]);
|
---|
| 840 | conns[i] = NULL;
|
---|
| 841 | sendstr("Could not bind: ", com->conn);
|
---|
| 842 | #ifdef LWIP_DEBUG
|
---|
| 843 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 844 | #else
|
---|
| 845 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 846 | #endif /* LWIP_DEBUG */
|
---|
| 847 | sendstr(NEWLINE, com->conn);
|
---|
| 848 | return ESUCCESS;
|
---|
| 849 | }
|
---|
| 850 |
|
---|
| 851 | sendstr("Connection set up, connection identifier is ", com->conn);
|
---|
| 852 | snprintf((char *)buffer, sizeof(buffer), "%d"NEWLINE, i);
|
---|
| 853 | netconn_write(com->conn, buffer, strlen((const char *)buffer), NETCONN_COPY);
|
---|
| 854 |
|
---|
| 855 | return ESUCCESS;
|
---|
| 856 | }
|
---|
| 857 | /*-----------------------------------------------------------------------------------*/
|
---|
| 858 | static s8_t
|
---|
| 859 | com_udpb(struct command *com)
|
---|
| 860 | {
|
---|
| 861 | ip_addr_t ipaddr;
|
---|
| 862 | #if LWIP_IPV4
|
---|
| 863 | u16_t lport;
|
---|
| 864 | #endif /* LWIP_IPV4 */
|
---|
| 865 | u16_t rport;
|
---|
| 866 | int i;
|
---|
| 867 | err_t err;
|
---|
| 868 | long tmp;
|
---|
| 869 |
|
---|
| 870 | tmp = strtol(com->args[0], NULL, 10);
|
---|
| 871 | if((tmp < 0) || (tmp > 0xffff)) {
|
---|
| 872 | sendstr("Invalid port number."NEWLINE, com->conn);
|
---|
| 873 | return ESUCCESS;
|
---|
| 874 | }
|
---|
| 875 | #if LWIP_IPV4
|
---|
| 876 | lport = (u16_t)tmp;
|
---|
| 877 | #endif /* LWIP_IPV4 */
|
---|
| 878 | if (ipaddr_aton(com->args[1], &ipaddr) == -1) {
|
---|
| 879 | sendstr(strerror(errno), com->conn);
|
---|
| 880 | return ESYNTAX;
|
---|
| 881 | }
|
---|
| 882 | tmp = strtol(com->args[2], NULL, 10);
|
---|
| 883 | if((tmp < 0) || (tmp > 0xffff)) {
|
---|
| 884 | sendstr("Invalid port number."NEWLINE, com->conn);
|
---|
| 885 | return ESUCCESS;
|
---|
| 886 | }
|
---|
| 887 | rport = (u16_t)tmp;
|
---|
| 888 |
|
---|
| 889 | /* Find the first unused connection in conns. */
|
---|
| 890 | for(i = 0; i < NCONNS && conns[i] != NULL; i++);
|
---|
| 891 |
|
---|
| 892 | if (i == NCONNS) {
|
---|
| 893 | sendstr("No more connections available, sorry."NEWLINE, com->conn);
|
---|
| 894 | return ESUCCESS;
|
---|
| 895 | }
|
---|
| 896 |
|
---|
| 897 | sendstr("Setting up UDP broadcast connection from port ", com->conn);
|
---|
| 898 | netconn_write(com->conn, com->args[0], strlen(com->args[0]), NETCONN_COPY);
|
---|
| 899 | sendstr(" to ", com->conn);
|
---|
| 900 | netconn_write(com->conn, com->args[1], strlen(com->args[1]), NETCONN_COPY);
|
---|
| 901 | sendstr(NEWLINE, com->conn);
|
---|
| 902 |
|
---|
| 903 | conns[i] = netconn_new(NETCONN_UDP);
|
---|
| 904 | if (conns[i] == NULL) {
|
---|
| 905 | sendstr("Could not create connection identifier (out of memory)."NEWLINE, com->conn);
|
---|
| 906 | return ESUCCESS;
|
---|
| 907 | }
|
---|
| 908 |
|
---|
| 909 | err = netconn_connect(conns[i], &ipaddr, rport);
|
---|
| 910 | if (err != ERR_OK) {
|
---|
| 911 | netconn_delete(conns[i]);
|
---|
| 912 | conns[i] = NULL;
|
---|
| 913 | sendstr("Could not connect to remote host: ", com->conn);
|
---|
| 914 | #ifdef LWIP_DEBUG
|
---|
| 915 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 916 | #else
|
---|
| 917 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 918 | #endif /* LWIP_DEBUG */
|
---|
| 919 | sendstr(NEWLINE, com->conn);
|
---|
| 920 | return ESUCCESS;
|
---|
| 921 | }
|
---|
| 922 |
|
---|
| 923 | #if LWIP_IPV4
|
---|
| 924 | if (IP_IS_V6_VAL(ipaddr)) {
|
---|
| 925 | err = netconn_bind(conns[i], &ip_addr_broadcast, lport);
|
---|
| 926 | if (err != ERR_OK) {
|
---|
| 927 | netconn_delete(conns[i]);
|
---|
| 928 | conns[i] = NULL;
|
---|
| 929 | sendstr("Could not bind: ", com->conn);
|
---|
| 930 | #ifdef LWIP_DEBUG
|
---|
| 931 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 932 | #else
|
---|
| 933 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 934 | #endif /* LWIP_DEBUG */
|
---|
| 935 | sendstr(NEWLINE, com->conn);
|
---|
| 936 | return ESUCCESS;
|
---|
| 937 | }
|
---|
| 938 | }
|
---|
| 939 | #endif /* LWIP_IPV4 */
|
---|
| 940 |
|
---|
| 941 | sendstr("Connection set up, connection identifier is ", com->conn);
|
---|
| 942 | snprintf((char *)buffer, sizeof(buffer), "%d"NEWLINE, i);
|
---|
| 943 | netconn_write(com->conn, buffer, strlen((const char *)buffer), NETCONN_COPY);
|
---|
| 944 |
|
---|
| 945 | return ESUCCESS;
|
---|
| 946 | }
|
---|
| 947 | /*-----------------------------------------------------------------------------------*/
|
---|
| 948 | static s8_t
|
---|
| 949 | com_usnd(struct command *com)
|
---|
| 950 | {
|
---|
| 951 | long i;
|
---|
| 952 | err_t err;
|
---|
| 953 | struct netbuf *buf;
|
---|
| 954 | char *mem;
|
---|
| 955 | u16_t len;
|
---|
| 956 | size_t tmp;
|
---|
| 957 |
|
---|
| 958 | i = strtol(com->args[0], NULL, 10);
|
---|
| 959 |
|
---|
| 960 | if (i > NCONNS) {
|
---|
| 961 | sendstr("Connection identifier too high."NEWLINE, com->conn);
|
---|
| 962 | return ESUCCESS;
|
---|
| 963 | }
|
---|
| 964 |
|
---|
| 965 | if (conns[i] == NULL) {
|
---|
| 966 | sendstr("Connection identifier not in use."NEWLINE, com->conn);
|
---|
| 967 | return ESUCCESS;
|
---|
| 968 | }
|
---|
| 969 | tmp = strlen(com->args[1]) + 1;
|
---|
| 970 | if (tmp > 0xffff) {
|
---|
| 971 | sendstr("Invalid length."NEWLINE, com->conn);
|
---|
| 972 | return ESUCCESS;
|
---|
| 973 | }
|
---|
| 974 | len = (u16_t)tmp;
|
---|
| 975 |
|
---|
| 976 | buf = netbuf_new();
|
---|
| 977 | mem = (char *)netbuf_alloc(buf, len);
|
---|
| 978 | if (mem == NULL) {
|
---|
| 979 | sendstr("Could not allocate memory for sending."NEWLINE, com->conn);
|
---|
| 980 | return ESUCCESS;
|
---|
| 981 | }
|
---|
| 982 | strncpy(mem, com->args[1], len);
|
---|
| 983 | err = netconn_send(conns[i], buf);
|
---|
| 984 | netbuf_delete(buf);
|
---|
| 985 | if (err != ERR_OK) {
|
---|
| 986 | sendstr("Could not send data: ", com->conn);
|
---|
| 987 | #ifdef LWIP_DEBUG
|
---|
| 988 | sendstr(lwip_strerr(err), com->conn);
|
---|
| 989 | #else
|
---|
| 990 | sendstr("(debugging must be turned on for error message to appear)", com->conn);
|
---|
| 991 | #endif /* LWIP_DEBUG */
|
---|
| 992 | sendstr(NEWLINE, com->conn);
|
---|
| 993 | return ESUCCESS;
|
---|
| 994 | }
|
---|
| 995 |
|
---|
| 996 | sendstr("Data sent."NEWLINE, com->conn);
|
---|
| 997 | return ESUCCESS;
|
---|
| 998 | }
|
---|
| 999 | /*-----------------------------------------------------------------------------------*/
|
---|
| 1000 | #if LWIP_SOCKET
|
---|
| 1001 | /*-----------------------------------------------------------------------------------*/
|
---|
| 1002 | static s8_t
|
---|
| 1003 | com_idxtoname(struct command *com)
|
---|
| 1004 | {
|
---|
| 1005 | long i = strtol(com->args[0], NULL, 10);
|
---|
| 1006 |
|
---|
| 1007 | if (lwip_if_indextoname((unsigned int)i, (char *)buffer)) {
|
---|
| 1008 | netconn_write(com->conn, buffer, strlen((const char *)buffer), NETCONN_COPY);
|
---|
| 1009 | sendstr(NEWLINE, com->conn);
|
---|
| 1010 | } else {
|
---|
| 1011 | snprintf((char *)buffer, sizeof(buffer), "if_indextoname() failed: %d"NEWLINE, errno);
|
---|
| 1012 | netconn_write(com->conn, buffer, strlen((const char *)buffer), NETCONN_COPY);
|
---|
| 1013 | }
|
---|
| 1014 | return ESUCCESS;
|
---|
| 1015 | }
|
---|
| 1016 | /*-----------------------------------------------------------------------------------*/
|
---|
| 1017 | static s8_t
|
---|
| 1018 | com_nametoidx(struct command *com)
|
---|
| 1019 | {
|
---|
| 1020 | unsigned int idx = lwip_if_nametoindex(com->args[0]);
|
---|
| 1021 |
|
---|
| 1022 | if (idx) {
|
---|
| 1023 | snprintf((char *)buffer, sizeof(buffer), "%u"NEWLINE, idx);
|
---|
| 1024 | netconn_write(com->conn, buffer, strlen((const char *)buffer), NETCONN_COPY);
|
---|
| 1025 | } else {
|
---|
| 1026 | sendstr("No interface found"NEWLINE, com->conn);
|
---|
| 1027 | }
|
---|
| 1028 | return ESUCCESS;
|
---|
| 1029 | }
|
---|
| 1030 | #endif /* LWIP_SOCKET */
|
---|
| 1031 | /*-----------------------------------------------------------------------------------*/
|
---|
| 1032 | #if LWIP_DNS
|
---|
| 1033 | static s8_t
|
---|
| 1034 | com_gethostbyname(struct command *com)
|
---|
| 1035 | {
|
---|
| 1036 | ip_addr_t addr;
|
---|
| 1037 | err_t err = netconn_gethostbyname(com->args[0], &addr);
|
---|
| 1038 |
|
---|
| 1039 | if (err == ERR_OK) {
|
---|
| 1040 | if (ipaddr_ntoa_r(&addr, (char *)buffer, sizeof(buffer))) {
|
---|
| 1041 | sendstr("Host found: ", com->conn);
|
---|
| 1042 | sendstr((char *)buffer, com->conn);
|
---|
| 1043 | sendstr(NEWLINE, com->conn);
|
---|
| 1044 | } else {
|
---|
| 1045 | sendstr("ipaddr_ntoa_r failed", com->conn);
|
---|
| 1046 | }
|
---|
| 1047 | } else {
|
---|
| 1048 | sendstr("No host found"NEWLINE, com->conn);
|
---|
| 1049 | }
|
---|
| 1050 | return ESUCCESS;
|
---|
| 1051 | }
|
---|
| 1052 | #endif /* LWIP_DNS */
|
---|
| 1053 | /*-----------------------------------------------------------------------------------*/
|
---|
| 1054 | static s8_t
|
---|
| 1055 | com_help(struct command *com)
|
---|
| 1056 | {
|
---|
| 1057 | sendstr(help_msg1, com->conn);
|
---|
| 1058 | sendstr(help_msg2, com->conn);
|
---|
| 1059 | sendstr(help_msg3, com->conn);
|
---|
| 1060 | return ESUCCESS;
|
---|
| 1061 | }
|
---|
| 1062 | /*-----------------------------------------------------------------------------------*/
|
---|
| 1063 | static s8_t
|
---|
| 1064 | parse_command(struct command *com, u32_t len)
|
---|
| 1065 | {
|
---|
| 1066 | u16_t i;
|
---|
| 1067 | u16_t bufp;
|
---|
| 1068 |
|
---|
| 1069 | if (strncmp((const char *)buffer, "open", 4) == 0) {
|
---|
| 1070 | com->exec = com_open;
|
---|
| 1071 | com->nargs = 2;
|
---|
| 1072 | } else if (strncmp((const char *)buffer, "lstn", 4) == 0) {
|
---|
| 1073 | com->exec = com_lstn;
|
---|
| 1074 | com->nargs = 1;
|
---|
| 1075 | } else if (strncmp((const char *)buffer, "acpt", 4) == 0) {
|
---|
| 1076 | com->exec = com_acpt;
|
---|
| 1077 | com->nargs = 1;
|
---|
| 1078 | } else if (strncmp((const char *)buffer, "clos", 4) == 0) {
|
---|
| 1079 | com->exec = com_clos;
|
---|
| 1080 | com->nargs = 1;
|
---|
| 1081 | #if LWIP_STATS
|
---|
| 1082 | } else if (strncmp((const char *)buffer, "stat", 4) == 0) {
|
---|
| 1083 | com->exec = com_stat;
|
---|
| 1084 | com->nargs = 0;
|
---|
| 1085 | #endif
|
---|
| 1086 | } else if (strncmp((const char *)buffer, "send", 4) == 0) {
|
---|
| 1087 | com->exec = com_send;
|
---|
| 1088 | com->nargs = 2;
|
---|
| 1089 | } else if (strncmp((const char *)buffer, "recv", 4) == 0) {
|
---|
| 1090 | com->exec = com_recv;
|
---|
| 1091 | com->nargs = 1;
|
---|
| 1092 | } else if (strncmp((const char *)buffer, "udpc", 4) == 0) {
|
---|
| 1093 | com->exec = com_udpc;
|
---|
| 1094 | com->nargs = 3;
|
---|
| 1095 | } else if (strncmp((const char *)buffer, "udpb", 4) == 0) {
|
---|
| 1096 | com->exec = com_udpb;
|
---|
| 1097 | com->nargs = 2;
|
---|
| 1098 | } else if (strncmp((const char *)buffer, "udpl", 4) == 0) {
|
---|
| 1099 | com->exec = com_udpl;
|
---|
| 1100 | com->nargs = 3;
|
---|
| 1101 | } else if (strncmp((const char *)buffer, "udpn", 4) == 0) {
|
---|
| 1102 | com->exec = com_udpn;
|
---|
| 1103 | com->nargs = 3;
|
---|
| 1104 | } else if (strncmp((const char *)buffer, "usnd", 4) == 0) {
|
---|
| 1105 | com->exec = com_usnd;
|
---|
| 1106 | com->nargs = 2;
|
---|
| 1107 | #if LWIP_SOCKET
|
---|
| 1108 | } else if (strncmp((const char *)buffer, "idxtoname", 9) == 0) {
|
---|
| 1109 | com->exec = com_idxtoname;
|
---|
| 1110 | com->nargs = 1;
|
---|
| 1111 | } else if (strncmp((const char *)buffer, "nametoidx", 9) == 0) {
|
---|
| 1112 | com->exec = com_nametoidx;
|
---|
| 1113 | com->nargs = 1;
|
---|
| 1114 | #endif /* LWIP_SOCKET */
|
---|
| 1115 | #if LWIP_DNS
|
---|
| 1116 | } else if (strncmp((const char *)buffer, "gethostnm", 9) == 0) {
|
---|
| 1117 | com->exec = com_gethostbyname;
|
---|
| 1118 | com->nargs = 1;
|
---|
| 1119 | #endif /* LWIP_DNS */
|
---|
| 1120 | } else if (strncmp((const char *)buffer, "help", 4) == 0) {
|
---|
| 1121 | com->exec = com_help;
|
---|
| 1122 | com->nargs = 0;
|
---|
| 1123 | } else if (strncmp((const char *)buffer, "quit", 4) == 0) {
|
---|
| 1124 | printf("quit"NEWLINE);
|
---|
| 1125 | return ECLOSED;
|
---|
| 1126 | } else {
|
---|
| 1127 | return ESYNTAX;
|
---|
| 1128 | }
|
---|
| 1129 |
|
---|
| 1130 | if (com->nargs == 0) {
|
---|
| 1131 | return ESUCCESS;
|
---|
| 1132 | }
|
---|
| 1133 | bufp = 0;
|
---|
| 1134 | for(; bufp < len && buffer[bufp] != ' '; bufp++);
|
---|
| 1135 | for(i = 0; i < 10; i++) {
|
---|
| 1136 | for(; bufp < len && buffer[bufp] == ' '; bufp++);
|
---|
| 1137 | if (buffer[bufp] == '\r' ||
|
---|
| 1138 | buffer[bufp] == '\n') {
|
---|
| 1139 | buffer[bufp] = 0;
|
---|
| 1140 | if (i < com->nargs - 1) {
|
---|
| 1141 | return ETOOFEW;
|
---|
| 1142 | }
|
---|
| 1143 | if (i > com->nargs - 1) {
|
---|
| 1144 | return ETOOMANY;
|
---|
| 1145 | }
|
---|
| 1146 | break;
|
---|
| 1147 | }
|
---|
| 1148 | if (bufp > len) {
|
---|
| 1149 | return ETOOFEW;
|
---|
| 1150 | }
|
---|
| 1151 | com->args[i] = (char *)&buffer[bufp];
|
---|
| 1152 | for(; bufp < len && buffer[bufp] != ' ' && buffer[bufp] != '\r' &&
|
---|
| 1153 | buffer[bufp] != '\n'; bufp++) {
|
---|
| 1154 | if (buffer[bufp] == '\\') {
|
---|
| 1155 | buffer[bufp] = ' ';
|
---|
| 1156 | }
|
---|
| 1157 | }
|
---|
| 1158 | if (bufp > len) {
|
---|
| 1159 | return ESYNTAX;
|
---|
| 1160 | }
|
---|
| 1161 | buffer[bufp] = 0;
|
---|
| 1162 | bufp++;
|
---|
| 1163 | if (i == com->nargs - 1) {
|
---|
| 1164 | break;
|
---|
| 1165 | }
|
---|
| 1166 |
|
---|
| 1167 | }
|
---|
| 1168 |
|
---|
| 1169 | return ESUCCESS;
|
---|
| 1170 | }
|
---|
| 1171 | /*-----------------------------------------------------------------------------------*/
|
---|
| 1172 | static void
|
---|
| 1173 | shell_error(s8_t err, struct netconn *conn)
|
---|
| 1174 | {
|
---|
| 1175 | switch (err) {
|
---|
| 1176 | case ESYNTAX:
|
---|
| 1177 | sendstr("## Syntax error"NEWLINE, conn);
|
---|
| 1178 | break;
|
---|
| 1179 | case ETOOFEW:
|
---|
| 1180 | sendstr("## Too few arguments to command given"NEWLINE, conn);
|
---|
| 1181 | break;
|
---|
| 1182 | case ETOOMANY:
|
---|
| 1183 | sendstr("## Too many arguments to command given"NEWLINE, conn);
|
---|
| 1184 | break;
|
---|
| 1185 | case ECLOSED:
|
---|
| 1186 | sendstr("## Connection closed"NEWLINE, conn);
|
---|
| 1187 | break;
|
---|
| 1188 | default:
|
---|
| 1189 | /* unknown error, don't assert here */
|
---|
| 1190 | break;
|
---|
| 1191 | }
|
---|
| 1192 | }
|
---|
| 1193 | /*-----------------------------------------------------------------------------------*/
|
---|
| 1194 | static void
|
---|
| 1195 | prompt(struct netconn *conn)
|
---|
| 1196 | {
|
---|
| 1197 | sendstr("> ", conn);
|
---|
| 1198 | }
|
---|
| 1199 | /*-----------------------------------------------------------------------------------*/
|
---|
| 1200 | static void
|
---|
| 1201 | shell_main(struct netconn *conn)
|
---|
| 1202 | {
|
---|
| 1203 | struct pbuf *p;
|
---|
| 1204 | u16_t len = 0, cur_len;
|
---|
| 1205 | struct command com;
|
---|
| 1206 | s8_t err;
|
---|
| 1207 | int i;
|
---|
| 1208 | err_t ret;
|
---|
| 1209 | #if SHELL_ECHO
|
---|
| 1210 | void *echomem;
|
---|
| 1211 | #endif /* SHELL_ECHO */
|
---|
| 1212 | uint8_t c, *pc, state = TELNET_STATE_DATA;
|
---|
| 1213 | int16_t clen;
|
---|
| 1214 |
|
---|
| 1215 | do {
|
---|
| 1216 | ret = netconn_recv_tcp_pbuf(conn, &p);
|
---|
| 1217 | if (ret == ERR_OK) {
|
---|
| 1218 | pc = p->payload;
|
---|
| 1219 | clen = p->tot_len;
|
---|
| 1220 | cur_len = len;
|
---|
| 1221 | while(clen-- > 0) {
|
---|
| 1222 | c = *pc++;
|
---|
| 1223 |
|
---|
| 1224 | switch(state){
|
---|
| 1225 | case TELNET_STATE_DATA:
|
---|
| 1226 | if(c == TELNET_IAC) {
|
---|
| 1227 | state = TELNET_STATE_IAC;
|
---|
| 1228 | break;
|
---|
| 1229 | }
|
---|
| 1230 | buffer[len++] = c;
|
---|
| 1231 |
|
---|
| 1232 | if(c == '\r')
|
---|
| 1233 | state = TELNET_STATE_CR;
|
---|
| 1234 | break;
|
---|
| 1235 |
|
---|
| 1236 | case TELNET_STATE_CR:
|
---|
| 1237 | /*
|
---|
| 1238 | * Convert CR+something as:
|
---|
| 1239 | * CR+NUL = CR only
|
---|
| 1240 | * CR+LF = CR+LF or CR only
|
---|
| 1241 | * CR+else = CR+LF+else or CR+else
|
---|
| 1242 | */
|
---|
| 1243 | if(c != 0x00){
|
---|
| 1244 | if(c != '\n')
|
---|
| 1245 | buffer[len++] = c;
|
---|
| 1246 | }
|
---|
| 1247 | state = TELNET_STATE_DATA;
|
---|
| 1248 | break;
|
---|
| 1249 |
|
---|
| 1250 | case TELNET_STATE_IAC:
|
---|
| 1251 | switch(c){
|
---|
| 1252 | case TELNET_AYT:
|
---|
| 1253 | sendstr(NEWLINE"[yes]"NEWLINE, conn);
|
---|
| 1254 | state = TELNET_STATE_DATA;
|
---|
| 1255 | break;
|
---|
| 1256 | case TELNET_SB:
|
---|
| 1257 | state = TELNET_STATE_SB;
|
---|
| 1258 | break;
|
---|
| 1259 | case TELNET_WILL:
|
---|
| 1260 | state = TELNET_STATE_WILL;
|
---|
| 1261 | break;
|
---|
| 1262 | case TELNET_WONT:
|
---|
| 1263 | state = TELNET_STATE_WONT;
|
---|
| 1264 | break;
|
---|
| 1265 | case TELNET_DO:
|
---|
| 1266 | state = TELNET_STATE_DO;
|
---|
| 1267 | break;
|
---|
| 1268 | case TELNET_DONT:
|
---|
| 1269 | state = TELNET_STATE_DONT;
|
---|
| 1270 | break;
|
---|
| 1271 | case TELNET_IAC:
|
---|
| 1272 | buffer[len++] = c;
|
---|
| 1273 | state = TELNET_STATE_DATA;
|
---|
| 1274 | break;
|
---|
| 1275 | default:
|
---|
| 1276 | state = TELNET_STATE_DATA;
|
---|
| 1277 | break;
|
---|
| 1278 | }
|
---|
| 1279 | break;
|
---|
| 1280 |
|
---|
| 1281 | case TELNET_STATE_SB:
|
---|
| 1282 | if(c == TELNET_IAC)
|
---|
| 1283 | state = TELNET_STATE_SE;
|
---|
| 1284 | break;
|
---|
| 1285 |
|
---|
| 1286 | case TELNET_STATE_SE:
|
---|
| 1287 | if (c == TELNET_SE)
|
---|
| 1288 | state = TELNET_STATE_DATA;
|
---|
| 1289 | else
|
---|
| 1290 | state = TELNET_STATE_SB;
|
---|
| 1291 | break;
|
---|
| 1292 | default:
|
---|
| 1293 | state = TELNET_STATE_DATA;
|
---|
| 1294 | break;
|
---|
| 1295 | }
|
---|
| 1296 | }
|
---|
| 1297 | #if SHELL_ECHO
|
---|
| 1298 | if(len > cur_len){
|
---|
| 1299 | echomem = mem_malloc(len-cur_len+1);
|
---|
| 1300 | if (echomem != NULL) {
|
---|
| 1301 | buffer[len] = '\n';
|
---|
| 1302 | MEMCPY(echomem, &buffer[cur_len], len-cur_len+1);
|
---|
| 1303 | if(buffer[len-1] == '\r')
|
---|
| 1304 | netconn_write(conn, echomem, len-cur_len+1, NETCONN_COPY);
|
---|
| 1305 | else
|
---|
| 1306 | netconn_write(conn, echomem, len-cur_len, NETCONN_COPY);
|
---|
| 1307 | mem_free(echomem);
|
---|
| 1308 | }
|
---|
| 1309 | }
|
---|
| 1310 | #endif /* SHELL_ECHO */
|
---|
| 1311 | pbuf_free(p);
|
---|
| 1312 | if (((len > 0) && ((buffer[len-1] == '\r') || (buffer[len-1] == '\n'))) ||
|
---|
| 1313 | (len >= BUFSIZE)) {
|
---|
| 1314 | if (buffer[0] != 0xff &&
|
---|
| 1315 | buffer[1] != 0xfe && len > 1) {
|
---|
| 1316 | err = parse_command(&com, len);
|
---|
| 1317 | if (err == ESUCCESS) {
|
---|
| 1318 | com.conn = conn;
|
---|
| 1319 | err = com.exec(&com);
|
---|
| 1320 | }
|
---|
| 1321 | if (err == ECLOSED) {
|
---|
| 1322 | printf("Closed"NEWLINE);
|
---|
| 1323 | shell_error(err, conn);
|
---|
| 1324 | goto close;
|
---|
| 1325 | }
|
---|
| 1326 | if (err != ESUCCESS) {
|
---|
| 1327 | shell_error(err, conn);
|
---|
| 1328 | }
|
---|
| 1329 | } else {
|
---|
| 1330 | sendstr(NEWLINE NEWLINE
|
---|
| 1331 | "lwIP simple interactive shell."NEWLINE
|
---|
| 1332 | "(c) Copyright 2001, Swedish Institute of Computer Science."NEWLINE
|
---|
| 1333 | "Written by Adam Dunkels."NEWLINE
|
---|
| 1334 | "For help, try the \"help\" command."NEWLINE, conn);
|
---|
| 1335 | }
|
---|
| 1336 | if (ret == ERR_OK) {
|
---|
| 1337 | prompt(conn);
|
---|
| 1338 | }
|
---|
| 1339 | len = 0;
|
---|
| 1340 | }
|
---|
| 1341 | }
|
---|
| 1342 | } while (ret == ERR_OK);
|
---|
| 1343 | if(err == ERR_CLSD)
|
---|
| 1344 | printf("disconnect !"NEWLINE);
|
---|
| 1345 | else
|
---|
| 1346 | printf("err %s"NEWLINE, lwip_strerr(ret));
|
---|
| 1347 |
|
---|
| 1348 | close:
|
---|
| 1349 | netconn_close(conn);
|
---|
| 1350 |
|
---|
| 1351 | for(i = 0; i < NCONNS; i++) {
|
---|
| 1352 | if (conns[i] != NULL) {
|
---|
| 1353 | netconn_delete(conns[i]);
|
---|
| 1354 | }
|
---|
| 1355 | conns[i] = NULL;
|
---|
| 1356 | }
|
---|
| 1357 | }
|
---|
| 1358 | /*-----------------------------------------------------------------------------------*/
|
---|
| 1359 | static void
|
---|
| 1360 | shell_thread(void *arg)
|
---|
| 1361 | {
|
---|
| 1362 | struct netconn *conn, *newconn;
|
---|
| 1363 | err_t err;
|
---|
| 1364 | LWIP_UNUSED_ARG(arg);
|
---|
| 1365 |
|
---|
| 1366 | #if LWIP_IPV4 /* LWIP_IPV4 */
|
---|
| 1367 | conn = netconn_new(NETCONN_TCP);
|
---|
| 1368 | LWIP_ERROR("shell: invalid conn", (conn != NULL), return;);
|
---|
| 1369 | err = netconn_bind(conn, IP_ADDR_ANY, 23);
|
---|
| 1370 | #elif LWIP_IPV6 /* LWIP_IPV6 */
|
---|
| 1371 | conn = netconn_new(NETCONN_TCP_IPV6);
|
---|
| 1372 | LWIP_ERROR("shell: invalid conn", (conn != NULL), return;);
|
---|
| 1373 | err = netconn_bind(conn, IP6_ADDR_ANY, 23);
|
---|
| 1374 | #endif /* LWIP_IPV6 */
|
---|
| 1375 | LWIP_ERROR("shell: netconn_bind failed", (err == ERR_OK), netconn_delete(conn); return;);
|
---|
| 1376 | err = netconn_listen(conn);
|
---|
| 1377 | LWIP_ERROR("shell: netconn_listen failed", (err == ERR_OK), netconn_delete(conn); return;);
|
---|
| 1378 |
|
---|
| 1379 | while (1) {
|
---|
| 1380 | err = netconn_accept(conn, &newconn);
|
---|
| 1381 | if (err == ERR_OK) {
|
---|
| 1382 | shell_main(newconn);
|
---|
| 1383 | netconn_delete(newconn);
|
---|
| 1384 | }
|
---|
| 1385 | }
|
---|
| 1386 | }
|
---|
| 1387 | /*-----------------------------------------------------------------------------------*/
|
---|
| 1388 | void
|
---|
| 1389 | shell_init(void)
|
---|
| 1390 | {
|
---|
| 1391 | sys_thread_new("shell_thread", shell_thread, NULL, DEFAULT_THREAD_STACKSIZE, DEFAULT_THREAD_PRIO);
|
---|
| 1392 | }
|
---|
| 1393 |
|
---|
| 1394 | #endif /* LWIP_NETCONN && LWIP_TCP */
|
---|