1 /***************************************************************************
2 * Copyright (C) 2005 by Dominic Rath *
3 * Dominic.Rath@gmx.de *
5 * Copyright (C) 2007-2010 Øyvind Harboe *
6 * oyvind.harboe@zylin.com *
8 * Copyright (C) 2008 by Spencer Oliver *
9 * spen@spen-soft.co.uk *
11 * This program is free software; you can redistribute it and/or modify *
12 * it under the terms of the GNU General Public License as published by *
13 * the Free Software Foundation; either version 2 of the License, or *
14 * (at your option) any later version. *
16 * This program is distributed in the hope that it will be useful, *
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
19 * GNU General Public License for more details. *
21 * You should have received a copy of the GNU General Public License *
22 * along with this program. If not, see <http://www.gnu.org/licenses/>. *
23 ***************************************************************************/
29 #include "telnet_server.h"
30 #include <target/target_request.h>
31 #include <helper/configuration.h>
32 #include <helper/list.h>
34 static char *telnet_port
;
36 static char *negotiate
=
37 "\xFF\xFB\x03" /* IAC WILL Suppress Go Ahead */
38 "\xFF\xFB\x01" /* IAC WILL Echo */
39 "\xFF\xFD\x03" /* IAC DO Suppress Go Ahead */
40 "\xFF\xFE\x01"; /* IAC DON'T Echo */
42 #define CTRL(c) (c - '@')
43 #define TELNET_HISTORY ".openocd_history"
45 /* The only way we can detect that the socket is closed is the first time
46 * we write to it, we will fail. Subsequent write operations will
49 static int telnet_write(struct connection
*connection
, const void *data
,
52 struct telnet_connection
*t_con
= connection
->priv
;
54 return ERROR_SERVER_REMOTE_CLOSED
;
56 if (connection_write(connection
, data
, len
) == len
)
59 return ERROR_SERVER_REMOTE_CLOSED
;
62 /* output an audible bell */
63 static int telnet_bell(struct connection
*connection
)
65 /* ("\a" does not work, at least on windows) */
66 return telnet_write(connection
, "\x07", 1);
69 static int telnet_prompt(struct connection
*connection
)
71 struct telnet_connection
*t_con
= connection
->priv
;
73 return telnet_write(connection
, t_con
->prompt
, strlen(t_con
->prompt
));
76 static int telnet_outputline(struct connection
*connection
, const char *line
)
80 /* process lines in buffer */
82 char *line_end
= strchr(line
, '\n');
89 telnet_write(connection
, line
, len
);
91 telnet_write(connection
, "\r\n", 2);
100 static int telnet_output(struct command_context
*cmd_ctx
, const char *line
)
102 struct connection
*connection
= cmd_ctx
->output_handler_priv
;
104 return telnet_outputline(connection
, line
);
107 static void telnet_log_callback(void *priv
, const char *file
, unsigned line
,
108 const char *function
, const char *string
)
110 struct connection
*connection
= priv
;
111 struct telnet_connection
*t_con
= connection
->priv
;
115 /* If the prompt is not visible, simply output the message. */
116 if (!t_con
->prompt_visible
) {
117 telnet_outputline(connection
, string
);
121 /* Clear the command line. */
122 tmp
= strlen(t_con
->prompt
) + t_con
->line_size
;
124 for (i
= 0; i
< tmp
; i
+= 16)
125 telnet_write(connection
, "\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b",
128 for (i
= 0; i
< tmp
; i
+= 16)
129 telnet_write(connection
, " ", MIN(tmp
- i
, 16));
131 for (i
= 0; i
< tmp
; i
+= 16)
132 telnet_write(connection
, "\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b",
135 telnet_outputline(connection
, string
);
137 /* Put the command line to its previous state. */
138 telnet_prompt(connection
);
139 telnet_write(connection
, t_con
->line
, t_con
->line_size
);
141 for (i
= t_con
->line_cursor
; i
< t_con
->line_size
; i
++)
142 telnet_write(connection
, "\b", 1);
145 static void telnet_load_history(struct telnet_connection
*t_con
)
148 char buffer
[TELNET_BUFFER_SIZE
];
151 char *history
= get_home_dir(TELNET_HISTORY
);
154 LOG_INFO("unable to get user home directory, telnet history will be disabled");
158 histfp
= fopen(history
, "rb");
162 while (fgets(buffer
, sizeof(buffer
), histfp
)) {
164 char *p
= strchr(buffer
, '\n');
167 if (buffer
[0] && i
< TELNET_LINE_HISTORY_SIZE
)
168 t_con
->history
[i
++] = strdup(buffer
);
171 t_con
->next_history
= i
;
172 t_con
->next_history
%= TELNET_LINE_HISTORY_SIZE
;
173 /* try to set to last entry - 1, that way we skip over any exit/shutdown cmds */
174 t_con
->current_history
= t_con
->next_history
> 0 ? i
- 1 : 0;
181 static void telnet_save_history(struct telnet_connection
*t_con
)
187 char *history
= get_home_dir(TELNET_HISTORY
);
190 LOG_INFO("unable to get user home directory, telnet history will be disabled");
194 histfp
= fopen(history
, "wb");
198 num
= TELNET_LINE_HISTORY_SIZE
;
199 i
= t_con
->current_history
+ 1;
200 i
%= TELNET_LINE_HISTORY_SIZE
;
202 while (!t_con
->history
[i
] && num
> 0) {
204 i
%= TELNET_LINE_HISTORY_SIZE
;
209 for (; num
> 0; num
--) {
210 fprintf(histfp
, "%s\n", t_con
->history
[i
]);
212 i
%= TELNET_LINE_HISTORY_SIZE
;
221 static int telnet_new_connection(struct connection
*connection
)
223 struct telnet_connection
*telnet_connection
;
224 struct telnet_service
*telnet_service
= connection
->service
->priv
;
227 telnet_connection
= malloc(sizeof(struct telnet_connection
));
229 if (!telnet_connection
) {
230 LOG_ERROR("Failed to allocate telnet connection.");
234 connection
->priv
= telnet_connection
;
236 /* initialize telnet connection information */
237 telnet_connection
->closed
= false;
238 telnet_connection
->line_size
= 0;
239 telnet_connection
->line_cursor
= 0;
240 telnet_connection
->prompt
= strdup("> ");
241 telnet_connection
->prompt_visible
= true;
242 telnet_connection
->state
= TELNET_STATE_DATA
;
244 /* output goes through telnet connection */
245 command_set_output_handler(connection
->cmd_ctx
, telnet_output
, connection
);
247 /* negotiate telnet options */
248 telnet_write(connection
, negotiate
, strlen(negotiate
));
250 /* print connection banner */
251 if (telnet_service
->banner
) {
252 telnet_write(connection
, telnet_service
->banner
, strlen(telnet_service
->banner
));
253 telnet_write(connection
, "\r\n", 2);
256 /* the prompt is always placed at the line beginning */
257 telnet_write(connection
, "\r", 1);
258 telnet_prompt(connection
);
260 /* initialize history */
261 for (i
= 0; i
< TELNET_LINE_HISTORY_SIZE
; i
++)
262 telnet_connection
->history
[i
] = NULL
;
263 telnet_connection
->next_history
= 0;
264 telnet_connection
->current_history
= 0;
265 telnet_load_history(telnet_connection
);
267 log_add_callback(telnet_log_callback
, connection
);
272 static void telnet_clear_line(struct connection
*connection
,
273 struct telnet_connection
*t_con
)
275 /* move to end of line */
276 if (t_con
->line_cursor
< t_con
->line_size
)
277 telnet_write(connection
,
278 t_con
->line
+ t_con
->line_cursor
,
279 t_con
->line_size
- t_con
->line_cursor
);
281 /* backspace, overwrite with space, backspace */
282 while (t_con
->line_size
> 0) {
283 telnet_write(connection
, "\b \b", 3);
286 t_con
->line_cursor
= 0;
289 static void telnet_history_go(struct connection
*connection
, int idx
)
291 struct telnet_connection
*t_con
= connection
->priv
;
293 if (t_con
->history
[idx
]) {
294 telnet_clear_line(connection
, t_con
);
295 t_con
->line_size
= strlen(t_con
->history
[idx
]);
296 t_con
->line_cursor
= t_con
->line_size
;
297 memcpy(t_con
->line
, t_con
->history
[idx
], t_con
->line_size
);
298 telnet_write(connection
, t_con
->line
, t_con
->line_size
);
299 t_con
->current_history
= idx
;
301 t_con
->state
= TELNET_STATE_DATA
;
304 static void telnet_history_up(struct connection
*connection
)
306 struct telnet_connection
*t_con
= connection
->priv
;
308 size_t last_history
= (t_con
->current_history
> 0) ?
309 t_con
->current_history
- 1 :
310 TELNET_LINE_HISTORY_SIZE
-1;
311 telnet_history_go(connection
, last_history
);
314 static void telnet_history_down(struct connection
*connection
)
316 struct telnet_connection
*t_con
= connection
->priv
;
319 next_history
= (t_con
->current_history
+ 1) % TELNET_LINE_HISTORY_SIZE
;
320 telnet_history_go(connection
, next_history
);
323 static int telnet_history_print(struct connection
*connection
)
325 struct telnet_connection
*tc
;
327 tc
= connection
->priv
;
329 for (size_t i
= 1; i
< TELNET_LINE_HISTORY_SIZE
; i
++) {
333 * The tc->next_history line contains empty string (unless NULL), thus
336 line
= tc
->history
[(tc
->next_history
+ i
) % TELNET_LINE_HISTORY_SIZE
];
339 telnet_write(connection
, line
, strlen(line
));
340 telnet_write(connection
, "\r\n\x00", 3);
347 /* The prompt is always placed at the line beginning. */
348 telnet_write(connection
, "\r", 1);
350 return telnet_prompt(connection
);
353 static void telnet_move_cursor(struct connection
*connection
, size_t pos
)
355 struct telnet_connection
*tc
;
358 tc
= connection
->priv
;
360 if (pos
< tc
->line_cursor
) {
361 tmp
= tc
->line_cursor
- pos
;
363 for (size_t i
= 0; i
< tmp
; i
+= 16)
364 telnet_write(connection
, "\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b\b",
367 tmp
= pos
- tc
->line_cursor
;
369 for (size_t i
= 0; i
< tmp
; i
+= 16)
370 telnet_write(connection
, tc
->line
+ tc
->line_cursor
+ i
,
374 tc
->line_cursor
= pos
;
377 /* check buffer size leaving one spare character for string null termination */
378 static inline bool telnet_can_insert(struct connection
*connection
, size_t len
)
380 struct telnet_connection
*t_con
= connection
->priv
;
382 return t_con
->line_size
+ len
< TELNET_LINE_MAX_SIZE
;
385 /* write to telnet console, and update the telnet_connection members
386 * this function is capable of inserting in the middle of a line
387 * please ensure that data does not contain special characters (\n, \r, \t, \b ...)
389 * returns false when it fails to insert the requested data
391 static bool telnet_insert(struct connection
*connection
, const void *data
, size_t len
)
393 struct telnet_connection
*t_con
= connection
->priv
;
395 if (!telnet_can_insert(connection
, len
)) {
396 telnet_bell(connection
);
400 if (t_con
->line_cursor
< t_con
->line_size
) {
401 /* we have some content after the cursor */
402 memmove(t_con
->line
+ t_con
->line_cursor
+ len
,
403 t_con
->line
+ t_con
->line_cursor
,
404 t_con
->line_size
- t_con
->line_cursor
);
407 strncpy(t_con
->line
+ t_con
->line_cursor
, data
, len
);
409 telnet_write(connection
,
410 t_con
->line
+ t_con
->line_cursor
,
411 t_con
->line_size
+ len
- t_con
->line_cursor
);
413 t_con
->line_size
+= len
;
414 t_con
->line_cursor
+= len
;
416 for (size_t i
= t_con
->line_cursor
; i
< t_con
->line_size
; i
++)
417 telnet_write(connection
, "\b", 1);
422 static void telnet_auto_complete(struct connection
*connection
)
424 struct telnet_connection
*t_con
= connection
->priv
;
425 struct command_context
*command_context
= connection
->cmd_ctx
;
434 /* user command sequence, either at line beginning
435 * or we start over after these characters ';', '[', '{' */
436 size_t seq_start
= (t_con
->line_cursor
== 0) ? 0 : (t_con
->line_cursor
- 1);
437 while (seq_start
> 0) {
438 char c
= t_con
->line
[seq_start
];
439 if (c
== ';' || c
== '[' || c
== '{') {
447 /* user command position in the line, ignore leading spaces */
448 size_t usr_cmd_pos
= seq_start
;
449 while ((usr_cmd_pos
< t_con
->line_cursor
) && isspace(t_con
->line
[usr_cmd_pos
]))
452 /* user command length */
453 size_t usr_cmd_len
= t_con
->line_cursor
- usr_cmd_pos
;
455 /* optimize multiple spaces in the user command,
456 * because info commands does not tolerate multiple spaces */
457 size_t optimized_spaces
= 0;
458 char query
[usr_cmd_len
+ 1];
459 for (size_t i
= 0; i
< usr_cmd_len
; i
++) {
460 if ((i
< usr_cmd_len
- 1) && isspace(t_con
->line
[usr_cmd_pos
+ i
])
461 && isspace(t_con
->line
[usr_cmd_pos
+ i
+ 1])) {
466 query
[i
- optimized_spaces
] = t_con
->line
[usr_cmd_pos
+ i
];
469 usr_cmd_len
-= optimized_spaces
;
470 query
[usr_cmd_len
] = '\0';
472 /* filter commands */
473 char *query_cmd
= alloc_printf("_telnet_autocomplete_helper {%s*}", query
);
476 LOG_ERROR("Out of memory");
480 int retval
= Jim_EvalSource(command_context
->interp
, __FILE__
, __LINE__
, query_cmd
);
482 if (retval
!= JIM_OK
)
485 Jim_Obj
*list
= Jim_GetResult(command_context
->interp
);
486 Jim_IncrRefCount(list
);
488 /* common prefix length of the matched commands */
489 size_t common_len
= 0;
490 char *first_match
= NULL
; /* used to compute the common prefix length */
492 int len
= Jim_ListLength(command_context
->interp
, list
);
493 for (int i
= 0; i
< len
; i
++) {
494 Jim_Obj
*elem
= Jim_ListGetIndex(command_context
->interp
, list
, i
);
495 Jim_IncrRefCount(elem
);
497 char *name
= (char *)Jim_GetString(elem
, NULL
);
499 /* validate the command */
500 bool ignore_cmd
= false;
501 Jim_Cmd
*jim_cmd
= Jim_GetCommand(command_context
->interp
, elem
, JIM_NONE
);
504 /* Why we are here? Let's ignore it! */
506 } else if (jimcmd_is_oocd_command(jim_cmd
)) {
507 struct command
*cmd
= jimcmd_privdata(jim_cmd
);
509 if (cmd
&& !cmd
->handler
&& !cmd
->jim_handler
) {
510 /* Initial part of a multi-word command. Ignore it! */
512 } else if (cmd
&& cmd
->mode
== COMMAND_CONFIG
) {
513 /* Not executable after config phase. Ignore it! */
518 /* save the command in the prediction list */
520 struct cmd_match
*match
= calloc(1, sizeof(struct cmd_match
));
522 LOG_ERROR("Out of memory");
523 Jim_DecrRefCount(command_context
->interp
, elem
);
524 break; /* break the for loop */
527 if (list_empty(&matches
)) {
528 common_len
= strlen(name
);
531 size_t new_common_len
= usr_cmd_len
; /* save some loops */
533 while (new_common_len
< common_len
&& first_match
[new_common_len
] == name
[new_common_len
])
536 common_len
= new_common_len
;
540 list_add_tail(&match
->lh
, &matches
);
543 Jim_DecrRefCount(command_context
->interp
, elem
);
545 /* end of command filtering */
547 /* proceed with auto-completion */
548 if (list_empty(&matches
))
549 telnet_bell(connection
);
550 else if (common_len
== usr_cmd_len
&& list_is_singular(&matches
) && t_con
->line_cursor
== t_con
->line_size
)
551 telnet_insert(connection
, " ", 1);
552 else if (common_len
> usr_cmd_len
) {
553 int completion_size
= common_len
- usr_cmd_len
;
554 if (telnet_insert(connection
, first_match
+ usr_cmd_len
, completion_size
)) {
555 /* in bash this extra space is only added when the cursor in at the end of line */
556 if (list_is_singular(&matches
) && t_con
->line_cursor
== t_con
->line_size
)
557 telnet_insert(connection
, " ", 1);
559 } else if (!list_is_singular(&matches
)) {
560 telnet_write(connection
, "\n\r", 2);
562 struct cmd_match
*match
;
563 list_for_each_entry(match
, &matches
, lh
) {
564 telnet_write(connection
, match
->cmd
, strlen(match
->cmd
));
565 telnet_write(connection
, "\n\r", 2);
568 telnet_prompt(connection
);
569 telnet_write(connection
, t_con
->line
, t_con
->line_size
);
571 /* restore the terminal visible cursor location */
572 for (size_t i
= t_con
->line_cursor
; i
< t_con
->line_size
; i
++)
573 telnet_write(connection
, "\b", 1);
576 /* destroy the command_list */
577 struct cmd_match
*tmp
, *match
;
578 list_for_each_entry_safe(match
, tmp
, &matches
, lh
)
581 Jim_DecrRefCount(command_context
->interp
, list
);
584 static int telnet_input(struct connection
*connection
)
587 unsigned char buffer
[TELNET_BUFFER_SIZE
];
588 unsigned char *buf_p
;
589 struct telnet_connection
*t_con
= connection
->priv
;
590 struct command_context
*command_context
= connection
->cmd_ctx
;
592 bytes_read
= connection_read(connection
, buffer
, TELNET_BUFFER_SIZE
);
595 return ERROR_SERVER_REMOTE_CLOSED
;
596 else if (bytes_read
== -1) {
597 LOG_ERROR("error during read: %s", strerror(errno
));
598 return ERROR_SERVER_REMOTE_CLOSED
;
603 switch (t_con
->state
) {
604 case TELNET_STATE_DATA
:
605 if (*buf_p
== 0xff) {
606 t_con
->state
= TELNET_STATE_IAC
;
608 if (isprint(*buf_p
)) { /* printable character */
609 telnet_insert(connection
, buf_p
, 1);
610 } else { /* non-printable */
611 if (*buf_p
== 0x1b) { /* escape */
612 t_con
->state
= TELNET_STATE_ESCAPE
;
613 t_con
->last_escape
= '\x00';
614 } else if ((*buf_p
== 0xd) || (*buf_p
== 0xa)) { /* CR/LF */
617 /* skip over combinations with CR/LF and NUL characters */
618 if ((bytes_read
> 1) && ((*(buf_p
+ 1) == 0xa) ||
619 (*(buf_p
+ 1) == 0xd))) {
623 if ((bytes_read
> 1) && (*(buf_p
+ 1) == 0)) {
627 t_con
->line
[t_con
->line_size
] = 0;
629 telnet_write(connection
, "\r\n\x00", 3);
631 if (strcmp(t_con
->line
, "history") == 0) {
632 retval
= telnet_history_print(connection
);
634 if (retval
!= ERROR_OK
)
640 /* save only non-blank not repeating lines in the history */
641 char *prev_line
= t_con
->history
[(t_con
->current_history
> 0) ?
642 t_con
->current_history
- 1 : TELNET_LINE_HISTORY_SIZE
-1];
643 if (*t_con
->line
&& (!prev_line
||
644 strcmp(t_con
->line
, prev_line
))) {
645 /* if the history slot is already taken, free it */
646 free(t_con
->history
[t_con
->next_history
]);
648 /* add line to history */
649 t_con
->history
[t_con
->next_history
] = strdup(t_con
->line
);
651 /* wrap history at TELNET_LINE_HISTORY_SIZE */
652 t_con
->next_history
= (t_con
->next_history
+ 1) %
653 TELNET_LINE_HISTORY_SIZE
;
655 /* current history line starts at the new entry */
656 t_con
->current_history
=
659 free(t_con
->history
[t_con
->current_history
]);
660 t_con
->history
[t_con
->current_history
] = strdup("");
663 t_con
->line_size
= 0;
665 /* to suppress prompt in log callback during command execution */
666 t_con
->prompt_visible
= false;
668 if (strcmp(t_con
->line
, "shutdown") == 0)
669 telnet_save_history(t_con
);
671 retval
= command_run_line(command_context
, t_con
->line
);
673 t_con
->line_cursor
= 0;
674 t_con
->prompt_visible
= true;
676 if (retval
== ERROR_COMMAND_CLOSE_CONNECTION
)
677 return ERROR_SERVER_REMOTE_CLOSED
;
679 /* the prompt is always * placed at the line beginning */
680 telnet_write(connection
, "\r", 1);
682 retval
= telnet_prompt(connection
);
683 if (retval
== ERROR_SERVER_REMOTE_CLOSED
)
684 return ERROR_SERVER_REMOTE_CLOSED
;
686 } else if ((*buf_p
== 0x7f) || (*buf_p
== 0x8)) { /* delete character */
687 if (t_con
->line_cursor
> 0) {
688 if (t_con
->line_cursor
!= t_con
->line_size
) {
690 telnet_write(connection
, "\b", 1);
691 t_con
->line_cursor
--;
693 memmove(t_con
->line
+ t_con
->line_cursor
,
694 t_con
->line
+ t_con
->line_cursor
+ 1,
698 telnet_write(connection
,
699 t_con
->line
+ t_con
->line_cursor
,
702 telnet_write(connection
, " \b", 2);
703 for (i
= t_con
->line_cursor
; i
< t_con
->line_size
; i
++)
704 telnet_write(connection
, "\b", 1);
707 t_con
->line_cursor
--;
708 /* back space: move the 'printer' head one char
709 * back, overwrite with space, move back again */
710 telnet_write(connection
, "\b \b", 3);
713 } else if (*buf_p
== 0x15) { /* clear line */
714 telnet_clear_line(connection
, t_con
);
715 } else if (*buf_p
== CTRL('B')) { /* cursor left */
716 if (t_con
->line_cursor
> 0) {
717 telnet_write(connection
, "\b", 1);
718 t_con
->line_cursor
--;
720 t_con
->state
= TELNET_STATE_DATA
;
721 } else if (*buf_p
== CTRL('C')) { /* interrupt */
722 /* print '^C' at line end, and display a new command prompt */
723 telnet_move_cursor(connection
, t_con
->line_size
);
724 telnet_write(connection
, "^C\n\r", 4);
725 t_con
->line_cursor
= 0;
726 t_con
->line_size
= 0;
727 telnet_prompt(connection
);
728 } else if (*buf_p
== CTRL('F')) { /* cursor right */
729 if (t_con
->line_cursor
< t_con
->line_size
)
730 telnet_write(connection
, t_con
->line
+ t_con
->line_cursor
++, 1);
731 t_con
->state
= TELNET_STATE_DATA
;
732 } else if (*buf_p
== CTRL('P')) { /* cursor up */
733 telnet_history_up(connection
);
734 } else if (*buf_p
== CTRL('N')) { /* cursor down */
735 telnet_history_down(connection
);
736 } else if (*buf_p
== CTRL('A')) { /* move the cursor to the beginning of the line */
737 telnet_move_cursor(connection
, 0);
738 } else if (*buf_p
== CTRL('E')) { /* move the cursor to the end of the line */
739 telnet_move_cursor(connection
, t_con
->line_size
);
740 } else if (*buf_p
== CTRL('K')) { /* kill line to end */
741 if (t_con
->line_cursor
< t_con
->line_size
) {
742 /* overwrite with space, until end of line, move back */
743 for (size_t i
= t_con
->line_cursor
; i
< t_con
->line_size
; i
++)
744 telnet_write(connection
, " ", 1);
745 for (size_t i
= t_con
->line_cursor
; i
< t_con
->line_size
; i
++)
746 telnet_write(connection
, "\b", 1);
747 t_con
->line
[t_con
->line_cursor
] = '\0';
748 t_con
->line_size
= t_con
->line_cursor
;
750 } else if (*buf_p
== '\t') {
751 telnet_auto_complete(connection
);
753 LOG_DEBUG("unhandled nonprintable: %2.2x", *buf_p
);
758 case TELNET_STATE_IAC
:
761 t_con
->state
= TELNET_STATE_DONT
;
764 t_con
->state
= TELNET_STATE_DO
;
767 t_con
->state
= TELNET_STATE_WONT
;
770 t_con
->state
= TELNET_STATE_WILL
;
774 case TELNET_STATE_SB
:
776 case TELNET_STATE_SE
:
778 case TELNET_STATE_WILL
:
779 case TELNET_STATE_WONT
:
780 case TELNET_STATE_DO
:
781 case TELNET_STATE_DONT
:
782 t_con
->state
= TELNET_STATE_DATA
;
784 case TELNET_STATE_ESCAPE
:
785 if (t_con
->last_escape
== '[') {
786 if (*buf_p
== 'D') { /* cursor left */
787 if (t_con
->line_cursor
> 0) {
788 telnet_write(connection
, "\b", 1);
789 t_con
->line_cursor
--;
791 t_con
->state
= TELNET_STATE_DATA
;
792 } else if (*buf_p
== 'C') { /* cursor right */
793 if (t_con
->line_cursor
< t_con
->line_size
)
794 telnet_write(connection
,
795 t_con
->line
+ t_con
->line_cursor
++, 1);
796 t_con
->state
= TELNET_STATE_DATA
;
797 } else if (*buf_p
== 'A') { /* cursor up */
798 telnet_history_up(connection
);
799 } else if (*buf_p
== 'B') { /* cursor down */
800 telnet_history_down(connection
);
801 } else if (*buf_p
== 'F') { /* end key */
802 telnet_move_cursor(connection
, t_con
->line_size
);
803 t_con
->state
= TELNET_STATE_DATA
;
804 } else if (*buf_p
== 'H') { /* home key */
805 telnet_move_cursor(connection
, 0);
806 t_con
->state
= TELNET_STATE_DATA
;
807 } else if (*buf_p
== '3') {
808 t_con
->last_escape
= *buf_p
;
810 t_con
->state
= TELNET_STATE_DATA
;
812 } else if (t_con
->last_escape
== '3') {
813 /* Remove character */
815 if (t_con
->line_cursor
< t_con
->line_size
) {
818 /* remove char from line buffer */
819 memmove(t_con
->line
+ t_con
->line_cursor
,
820 t_con
->line
+ t_con
->line_cursor
+ 1,
821 t_con
->line_size
- t_con
->line_cursor
);
823 /* print remainder of buffer */
824 telnet_write(connection
, t_con
->line
+ t_con
->line_cursor
,
825 t_con
->line_size
- t_con
->line_cursor
);
826 /* overwrite last char with whitespace */
827 telnet_write(connection
, " \b", 2);
829 /* move back to cursor position*/
830 for (i
= t_con
->line_cursor
; i
< t_con
->line_size
; i
++)
831 telnet_write(connection
, "\b", 1);
834 t_con
->state
= TELNET_STATE_DATA
;
836 t_con
->state
= TELNET_STATE_DATA
;
837 } else if (t_con
->last_escape
== '\x00') {
839 t_con
->last_escape
= *buf_p
;
841 t_con
->state
= TELNET_STATE_DATA
;
843 LOG_ERROR("BUG: unexpected value in t_con->last_escape");
844 t_con
->state
= TELNET_STATE_DATA
;
849 LOG_ERROR("unknown telnet state");
860 static int telnet_connection_closed(struct connection
*connection
)
862 struct telnet_connection
*t_con
= connection
->priv
;
865 log_remove_callback(telnet_log_callback
, connection
);
868 t_con
->prompt
= NULL
;
870 /* save telnet history */
871 telnet_save_history(t_con
);
873 for (i
= 0; i
< TELNET_LINE_HISTORY_SIZE
; i
++) {
874 free(t_con
->history
[i
]);
875 t_con
->history
[i
] = NULL
;
878 /* if this connection registered a debug-message receiver delete it */
879 delete_debug_msg_receiver(connection
->cmd_ctx
, NULL
);
881 free(connection
->priv
);
882 connection
->priv
= NULL
;
887 int telnet_init(char *banner
)
889 if (strcmp(telnet_port
, "disabled") == 0) {
890 LOG_INFO("telnet server disabled");
894 struct telnet_service
*telnet_service
=
895 malloc(sizeof(struct telnet_service
));
897 if (!telnet_service
) {
898 LOG_ERROR("Failed to allocate telnet service.");
902 telnet_service
->banner
= banner
;
904 int ret
= add_service("telnet", telnet_port
, CONNECTION_LIMIT_UNLIMITED
,
905 telnet_new_connection
, telnet_input
, telnet_connection_closed
,
908 if (ret
!= ERROR_OK
) {
909 free(telnet_service
);
916 /* daemon configuration command telnet_port */
917 COMMAND_HANDLER(handle_telnet_port_command
)
919 return CALL_COMMAND_HANDLER(server_pipe_command
, &telnet_port
);
922 COMMAND_HANDLER(handle_exit_command
)
924 return ERROR_COMMAND_CLOSE_CONNECTION
;
927 static const struct command_registration telnet_command_handlers
[] = {
930 .handler
= handle_exit_command
,
931 .mode
= COMMAND_EXEC
,
933 .help
= "exit telnet session",
936 .name
= "telnet_port",
937 .handler
= handle_telnet_port_command
,
938 .mode
= COMMAND_CONFIG
,
939 .help
= "Specify port on which to listen "
940 "for incoming telnet connections. "
941 "Read help on 'gdb_port'.",
942 .usage
= "[port_num]",
944 COMMAND_REGISTRATION_DONE
947 int telnet_register_commands(struct command_context
*cmd_ctx
)
949 telnet_port
= strdup("4444");
950 return register_commands(cmd_ctx
, NULL
, telnet_command_handlers
);
953 void telnet_service_free(void)
Linking to existing account procedure
If you already have an account and want to add another login method
you
MUST first sign in with your existing account and
then change URL to read
https://review.openocd.org/login/?link
to get to this page again but this time it'll work for linking. Thank you.
SSH host keys fingerprints
1024 SHA256:YKx8b7u5ZWdcbp7/4AeXNaqElP49m6QrwfXaqQGJAOk gerrit-code-review@openocd.zylin.com (DSA)
384 SHA256:jHIbSQa4REvwCFG4cq5LBlBLxmxSqelQPem/EXIrxjk gerrit-code-review@openocd.org (ECDSA)
521 SHA256:UAOPYkU9Fjtcao0Ul/Rrlnj/OsQvt+pgdYSZ4jOYdgs gerrit-code-review@openocd.org (ECDSA)
256 SHA256:A13M5QlnozFOvTllybRZH6vm7iSt0XLxbA48yfc2yfY gerrit-code-review@openocd.org (ECDSA)
256 SHA256:spYMBqEYoAOtK7yZBrcwE8ZpYt6b68Cfh9yEVetvbXg gerrit-code-review@openocd.org (ED25519)
+--[ED25519 256]--+
|=.. |
|+o.. . |
|*.o . . |
|+B . . . |
|Bo. = o S |
|Oo.+ + = |
|oB=.* = . o |
| =+=.+ + E |
|. .=o . o |
+----[SHA256]-----+
2048 SHA256:0Onrb7/PHjpo6iVZ7xQX2riKN83FJ3KGU0TvI0TaFG4 gerrit-code-review@openocd.zylin.com (RSA)