Linux Audio

Check our new training course

Loading...
v6.2
  1/*
  2 * Kernel Debugger Architecture Independent Console I/O handler
  3 *
  4 * This file is subject to the terms and conditions of the GNU General Public
  5 * License.  See the file "COPYING" in the main directory of this archive
  6 * for more details.
  7 *
  8 * Copyright (c) 1999-2006 Silicon Graphics, Inc.  All Rights Reserved.
  9 * Copyright (c) 2009 Wind River Systems, Inc.  All Rights Reserved.
 10 */
 11
 
 12#include <linux/types.h>
 13#include <linux/ctype.h>
 14#include <linux/kernel.h>
 15#include <linux/init.h>
 16#include <linux/kdev_t.h>
 17#include <linux/console.h>
 18#include <linux/string.h>
 19#include <linux/sched.h>
 20#include <linux/smp.h>
 21#include <linux/nmi.h>
 22#include <linux/delay.h>
 23#include <linux/kgdb.h>
 24#include <linux/kdb.h>
 25#include <linux/kallsyms.h>
 26#include "kdb_private.h"
 27
 28#define CMD_BUFLEN 256
 29char kdb_prompt_str[CMD_BUFLEN];
 30
 31int kdb_trap_printk;
 32int kdb_printf_cpu = -1;
 33
 34static int kgdb_transition_check(char *buffer)
 35{
 36	if (buffer[0] != '+' && buffer[0] != '$') {
 37		KDB_STATE_SET(KGDB_TRANS);
 38		kdb_printf("%s", buffer);
 39	} else {
 40		int slen = strlen(buffer);
 41		if (slen > 3 && buffer[slen - 3] == '#') {
 42			kdb_gdb_state_pass(buffer);
 43			strcpy(buffer, "kgdb");
 44			KDB_STATE_SET(DOING_KGDB);
 45			return 1;
 46		}
 47	}
 48	return 0;
 49}
 50
 51/**
 52 * kdb_handle_escape() - validity check on an accumulated escape sequence.
 53 * @buf:	Accumulated escape characters to be examined. Note that buf
 54 *		is not a string, it is an array of characters and need not be
 55 *		nil terminated.
 56 * @sz:		Number of accumulated escape characters.
 57 *
 58 * Return: -1 if the escape sequence is unwanted, 0 if it is incomplete,
 59 * otherwise it returns a mapped key value to pass to the upper layers.
 60 */
 61static int kdb_handle_escape(char *buf, size_t sz)
 62{
 63	char *lastkey = buf + sz - 1;
 64
 65	switch (sz) {
 66	case 1:
 67		if (*lastkey == '\e')
 68			return 0;
 69		break;
 70
 71	case 2: /* \e<something> */
 72		if (*lastkey == '[')
 73			return 0;
 74		break;
 75
 76	case 3:
 77		switch (*lastkey) {
 78		case 'A': /* \e[A, up arrow */
 79			return 16;
 80		case 'B': /* \e[B, down arrow */
 81			return 14;
 82		case 'C': /* \e[C, right arrow */
 83			return 6;
 84		case 'D': /* \e[D, left arrow */
 85			return 2;
 86		case '1': /* \e[<1,3,4>], may be home, del, end */
 87		case '3':
 88		case '4':
 89			return 0;
 90		}
 91		break;
 92
 93	case 4:
 94		if (*lastkey == '~') {
 95			switch (buf[2]) {
 96			case '1': /* \e[1~, home */
 97				return 1;
 98			case '3': /* \e[3~, del */
 99				return 4;
100			case '4': /* \e[4~, end */
101				return 5;
102			}
103		}
104		break;
105	}
106
107	return -1;
108}
109
110/**
111 * kdb_getchar() - Read a single character from a kdb console (or consoles).
112 *
113 * Other than polling the various consoles that are currently enabled,
114 * most of the work done in this function is dealing with escape sequences.
115 *
116 * An escape key could be the start of a vt100 control sequence such as \e[D
117 * (left arrow) or it could be a character in its own right.  The standard
118 * method for detecting the difference is to wait for 2 seconds to see if there
119 * are any other characters.  kdb is complicated by the lack of a timer service
120 * (interrupts are off), by multiple input sources. Escape sequence processing
121 * has to be done as states in the polling loop.
122 *
123 * Return: The key pressed or a control code derived from an escape sequence.
124 */
125char kdb_getchar(void)
126{
127#define ESCAPE_UDELAY 1000
128#define ESCAPE_DELAY (2*1000000/ESCAPE_UDELAY) /* 2 seconds worth of udelays */
129	char buf[4];	/* longest vt100 escape sequence is 4 bytes */
130	char *pbuf = buf;
131	int escape_delay = 0;
132	get_char_func *f, *f_prev = NULL;
133	int key;
134
135	for (f = &kdb_poll_funcs[0]; ; ++f) {
136		if (*f == NULL) {
137			/* Reset NMI watchdog once per poll loop */
138			touch_nmi_watchdog();
139			f = &kdb_poll_funcs[0];
140		}
141
 
 
 
 
 
 
 
 
 
 
142		key = (*f)();
143		if (key == -1) {
144			if (escape_delay) {
145				udelay(ESCAPE_UDELAY);
146				if (--escape_delay == 0)
147					return '\e';
148			}
149			continue;
150		}
151
152		/*
153		 * When the first character is received (or we get a change
154		 * input source) we set ourselves up to handle an escape
155		 * sequences (just in case).
156		 */
157		if (f_prev != f) {
158			f_prev = f;
159			pbuf = buf;
160			escape_delay = ESCAPE_DELAY;
 
 
161		}
162
163		*pbuf++ = key;
164		key = kdb_handle_escape(buf, pbuf - buf);
165		if (key < 0) /* no escape sequence; return best character */
166			return buf[pbuf - buf == 2 ? 1 : 0];
167		if (key > 0)
168			return key;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
169	}
170
171	unreachable();
172}
173
174/*
175 * kdb_read
176 *
177 *	This function reads a string of characters, terminated by
178 *	a newline, or by reaching the end of the supplied buffer,
179 *	from the current kernel debugger console device.
180 * Parameters:
181 *	buffer	- Address of character buffer to receive input characters.
182 *	bufsize - size, in bytes, of the character buffer
183 * Returns:
184 *	Returns a pointer to the buffer containing the received
185 *	character string.  This string will be terminated by a
186 *	newline character.
187 * Locking:
188 *	No locks are required to be held upon entry to this
189 *	function.  It is not reentrant - it relies on the fact
190 *	that while kdb is running on only one "master debug" cpu.
191 * Remarks:
192 *	The buffer size must be >= 2.
 
 
 
 
 
 
 
 
 
 
193 */
194
195static char *kdb_read(char *buffer, size_t bufsize)
196{
197	char *cp = buffer;
198	char *bufend = buffer+bufsize-2;	/* Reserve space for newline
199						 * and null byte */
200	char *lastchar;
201	char *p_tmp;
202	char tmp;
203	static char tmpbuffer[CMD_BUFLEN];
204	int len = strlen(buffer);
205	int len_tmp;
206	int tab = 0;
207	int count;
208	int i;
209	int diag, dtab_count;
210	int key, buf_size, ret;
211
212
213	diag = kdbgetintenv("DTABCOUNT", &dtab_count);
214	if (diag)
215		dtab_count = 30;
216
217	if (len > 0) {
218		cp += len;
219		if (*(buffer+len-1) == '\n')
220			cp--;
221	}
222
223	lastchar = cp;
224	*cp = '\0';
225	kdb_printf("%s", buffer);
226poll_again:
227	key = kdb_getchar();
 
 
228	if (key != 9)
229		tab = 0;
230	switch (key) {
231	case 8: /* backspace */
232		if (cp > buffer) {
233			if (cp < lastchar) {
234				memcpy(tmpbuffer, cp, lastchar - cp);
235				memcpy(cp-1, tmpbuffer, lastchar - cp);
236			}
237			*(--lastchar) = '\0';
238			--cp;
239			kdb_printf("\b%s \r", cp);
240			tmp = *cp;
241			*cp = '\0';
242			kdb_printf(kdb_prompt_str);
243			kdb_printf("%s", buffer);
244			*cp = tmp;
245		}
246		break;
247	case 13: /* enter */
248		*lastchar++ = '\n';
249		*lastchar++ = '\0';
250		if (!KDB_STATE(KGDB_TRANS)) {
251			KDB_STATE_SET(KGDB_TRANS);
252			kdb_printf("%s", buffer);
253		}
254		kdb_printf("\n");
255		return buffer;
256	case 4: /* Del */
257		if (cp < lastchar) {
258			memcpy(tmpbuffer, cp+1, lastchar - cp - 1);
259			memcpy(cp, tmpbuffer, lastchar - cp - 1);
260			*(--lastchar) = '\0';
261			kdb_printf("%s \r", cp);
262			tmp = *cp;
263			*cp = '\0';
264			kdb_printf(kdb_prompt_str);
265			kdb_printf("%s", buffer);
266			*cp = tmp;
267		}
268		break;
269	case 1: /* Home */
270		if (cp > buffer) {
271			kdb_printf("\r");
272			kdb_printf(kdb_prompt_str);
273			cp = buffer;
274		}
275		break;
276	case 5: /* End */
277		if (cp < lastchar) {
278			kdb_printf("%s", cp);
279			cp = lastchar;
280		}
281		break;
282	case 2: /* Left */
283		if (cp > buffer) {
284			kdb_printf("\b");
285			--cp;
286		}
287		break;
288	case 14: /* Down */
289		memset(tmpbuffer, ' ',
290		       strlen(kdb_prompt_str) + (lastchar-buffer));
291		*(tmpbuffer+strlen(kdb_prompt_str) +
292		  (lastchar-buffer)) = '\0';
293		kdb_printf("\r%s\r", tmpbuffer);
294		*lastchar = (char)key;
295		*(lastchar+1) = '\0';
296		return lastchar;
297	case 6: /* Right */
298		if (cp < lastchar) {
299			kdb_printf("%c", *cp);
300			++cp;
301		}
302		break;
303	case 16: /* Up */
304		memset(tmpbuffer, ' ',
305		       strlen(kdb_prompt_str) + (lastchar-buffer));
306		*(tmpbuffer+strlen(kdb_prompt_str) +
307		  (lastchar-buffer)) = '\0';
308		kdb_printf("\r%s\r", tmpbuffer);
309		*lastchar = (char)key;
310		*(lastchar+1) = '\0';
311		return lastchar;
312	case 9: /* Tab */
313		if (tab < 2)
314			++tab;
315		p_tmp = buffer;
316		while (*p_tmp == ' ')
317			p_tmp++;
318		if (p_tmp > cp)
319			break;
320		memcpy(tmpbuffer, p_tmp, cp-p_tmp);
321		*(tmpbuffer + (cp-p_tmp)) = '\0';
322		p_tmp = strrchr(tmpbuffer, ' ');
323		if (p_tmp)
324			++p_tmp;
325		else
326			p_tmp = tmpbuffer;
327		len = strlen(p_tmp);
328		buf_size = sizeof(tmpbuffer) - (p_tmp - tmpbuffer);
329		count = kallsyms_symbol_complete(p_tmp, buf_size);
330		if (tab == 2 && count > 0) {
331			kdb_printf("\n%d symbols are found.", count);
332			if (count > dtab_count) {
333				count = dtab_count;
334				kdb_printf(" But only first %d symbols will"
335					   " be printed.\nYou can change the"
336					   " environment variable DTABCOUNT.",
337					   count);
338			}
339			kdb_printf("\n");
340			for (i = 0; i < count; i++) {
341				ret = kallsyms_symbol_next(p_tmp, i, buf_size);
342				if (WARN_ON(!ret))
343					break;
344				if (ret != -E2BIG)
345					kdb_printf("%s ", p_tmp);
346				else
347					kdb_printf("%s... ", p_tmp);
348				*(p_tmp + len) = '\0';
349			}
350			if (i >= dtab_count)
351				kdb_printf("...");
352			kdb_printf("\n");
353			kdb_printf(kdb_prompt_str);
354			kdb_printf("%s", buffer);
355		} else if (tab != 2 && count > 0) {
356			len_tmp = strlen(p_tmp);
357			strncpy(p_tmp+len_tmp, cp, lastchar-cp+1);
358			len_tmp = strlen(p_tmp);
359			strncpy(cp, p_tmp+len, len_tmp-len + 1);
360			len = len_tmp - len;
361			kdb_printf("%s", cp);
362			cp += len;
363			lastchar += len;
364		}
365		kdb_nextline = 1; /* reset output line number */
366		break;
367	default:
368		if (key >= 32 && lastchar < bufend) {
369			if (cp < lastchar) {
370				memcpy(tmpbuffer, cp, lastchar - cp);
371				memcpy(cp+1, tmpbuffer, lastchar - cp);
372				*++lastchar = '\0';
373				*cp = key;
374				kdb_printf("%s\r", cp);
375				++cp;
376				tmp = *cp;
377				*cp = '\0';
378				kdb_printf(kdb_prompt_str);
379				kdb_printf("%s", buffer);
380				*cp = tmp;
381			} else {
382				*++lastchar = '\0';
383				*cp++ = key;
384				/* The kgdb transition check will hide
385				 * printed characters if we think that
386				 * kgdb is connecting, until the check
387				 * fails */
388				if (!KDB_STATE(KGDB_TRANS)) {
389					if (kgdb_transition_check(buffer))
390						return buffer;
391				} else {
392					kdb_printf("%c", key);
393				}
394			}
395			/* Special escape to kgdb */
396			if (lastchar - buffer >= 5 &&
397			    strcmp(lastchar - 5, "$?#3f") == 0) {
398				kdb_gdb_state_pass(lastchar - 5);
399				strcpy(buffer, "kgdb");
400				KDB_STATE_SET(DOING_KGDB);
401				return buffer;
402			}
403			if (lastchar - buffer >= 11 &&
404			    strcmp(lastchar - 11, "$qSupported") == 0) {
405				kdb_gdb_state_pass(lastchar - 11);
406				strcpy(buffer, "kgdb");
407				KDB_STATE_SET(DOING_KGDB);
408				return buffer;
409			}
410		}
411		break;
412	}
413	goto poll_again;
414}
415
416/*
417 * kdb_getstr
418 *
419 *	Print the prompt string and read a command from the
420 *	input device.
421 *
422 * Parameters:
423 *	buffer	Address of buffer to receive command
424 *	bufsize Size of buffer in bytes
425 *	prompt	Pointer to string to use as prompt string
426 * Returns:
427 *	Pointer to command buffer.
428 * Locking:
429 *	None.
430 * Remarks:
431 *	For SMP kernels, the processor number will be
432 *	substituted for %d, %x or %o in the prompt.
433 */
434
435char *kdb_getstr(char *buffer, size_t bufsize, const char *prompt)
436{
437	if (prompt && kdb_prompt_str != prompt)
438		strscpy(kdb_prompt_str, prompt, CMD_BUFLEN);
439	kdb_printf(kdb_prompt_str);
440	kdb_nextline = 1;	/* Prompt and input resets line number */
441	return kdb_read(buffer, bufsize);
442}
443
444/*
445 * kdb_input_flush
446 *
447 *	Get rid of any buffered console input.
448 *
449 * Parameters:
450 *	none
451 * Returns:
452 *	nothing
453 * Locking:
454 *	none
455 * Remarks:
456 *	Call this function whenever you want to flush input.  If there is any
457 *	outstanding input, it ignores all characters until there has been no
458 *	data for approximately 1ms.
459 */
460
461static void kdb_input_flush(void)
462{
463	get_char_func *f;
464	int res;
465	int flush_delay = 1;
466	while (flush_delay) {
467		flush_delay--;
468empty:
469		touch_nmi_watchdog();
470		for (f = &kdb_poll_funcs[0]; *f; ++f) {
471			res = (*f)();
472			if (res != -1) {
473				flush_delay = 1;
474				goto empty;
475			}
476		}
477		if (flush_delay)
478			mdelay(1);
479	}
480}
481
482/*
483 * kdb_printf
484 *
485 *	Print a string to the output device(s).
486 *
487 * Parameters:
488 *	printf-like format and optional args.
489 * Returns:
490 *	0
491 * Locking:
492 *	None.
493 * Remarks:
494 *	use 'kdbcons->write()' to avoid polluting 'log_buf' with
495 *	kdb output.
496 *
497 *  If the user is doing a cmd args | grep srch
498 *  then kdb_grepping_flag is set.
499 *  In that case we need to accumulate full lines (ending in \n) before
500 *  searching for the pattern.
501 */
502
503static char kdb_buffer[256];	/* A bit too big to go on stack */
504static char *next_avail = kdb_buffer;
505static int  size_avail;
506static int  suspend_grep;
507
508/*
509 * search arg1 to see if it contains arg2
510 * (kdmain.c provides flags for ^pat and pat$)
511 *
512 * return 1 for found, 0 for not found
513 */
514static int kdb_search_string(char *searched, char *searchfor)
515{
516	char firstchar, *cp;
517	int len1, len2;
518
519	/* not counting the newline at the end of "searched" */
520	len1 = strlen(searched)-1;
521	len2 = strlen(searchfor);
522	if (len1 < len2)
523		return 0;
524	if (kdb_grep_leading && kdb_grep_trailing && len1 != len2)
525		return 0;
526	if (kdb_grep_leading) {
527		if (!strncmp(searched, searchfor, len2))
528			return 1;
529	} else if (kdb_grep_trailing) {
530		if (!strncmp(searched+len1-len2, searchfor, len2))
531			return 1;
532	} else {
533		firstchar = *searchfor;
534		cp = searched;
535		while ((cp = strchr(cp, firstchar))) {
536			if (!strncmp(cp, searchfor, len2))
537				return 1;
538			cp++;
539		}
540	}
541	return 0;
542}
543
544static void kdb_msg_write(const char *msg, int msg_len)
545{
546	struct console *c;
547	const char *cp;
548	int cookie;
549	int len;
550
551	if (msg_len == 0)
552		return;
553
554	cp = msg;
555	len = msg_len;
556
557	while (len--) {
558		dbg_io_ops->write_char(*cp);
559		cp++;
560	}
561
562	/*
563	 * The console_srcu_read_lock() only provides safe console list
564	 * traversal. The use of the ->write() callback relies on all other
565	 * CPUs being stopped at the moment and console drivers being able to
566	 * handle reentrance when @oops_in_progress is set.
567	 *
568	 * There is no guarantee that every console driver can handle
569	 * reentrance in this way; the developer deploying the debugger
570	 * is responsible for ensuring that the console drivers they
571	 * have selected handle reentrance appropriately.
572	 */
573	cookie = console_srcu_read_lock();
574	for_each_console_srcu(c) {
575		if (!(console_srcu_read_flags(c) & CON_ENABLED))
576			continue;
577		if (c == dbg_io_ops->cons)
578			continue;
579		/*
580		 * Set oops_in_progress to encourage the console drivers to
581		 * disregard their internal spin locks: in the current calling
582		 * context the risk of deadlock is a bigger problem than risks
583		 * due to re-entering the console driver. We operate directly on
584		 * oops_in_progress rather than using bust_spinlocks() because
585		 * the calls bust_spinlocks() makes on exit are not appropriate
586		 * for this calling context.
587		 */
588		++oops_in_progress;
589		c->write(c, msg, msg_len);
590		--oops_in_progress;
591		touch_nmi_watchdog();
592	}
593	console_srcu_read_unlock(cookie);
594}
595
596int vkdb_printf(enum kdb_msgsrc src, const char *fmt, va_list ap)
597{
598	int diag;
599	int linecount;
600	int colcount;
601	int logging, saved_loglevel = 0;
602	int retlen = 0;
603	int fnd, len;
604	int this_cpu, old_cpu;
605	char *cp, *cp2, *cphold = NULL, replaced_byte = ' ';
606	char *moreprompt = "more> ";
607	unsigned long flags;
 
608
609	/* Serialize kdb_printf if multiple cpus try to write at once.
610	 * But if any cpu goes recursive in kdb, just print the output,
611	 * even if it is interleaved with any other text.
612	 */
613	local_irq_save(flags);
614	this_cpu = smp_processor_id();
615	for (;;) {
616		old_cpu = cmpxchg(&kdb_printf_cpu, -1, this_cpu);
617		if (old_cpu == -1 || old_cpu == this_cpu)
618			break;
619
620		cpu_relax();
621	}
622
623	diag = kdbgetintenv("LINES", &linecount);
624	if (diag || linecount <= 1)
625		linecount = 24;
626
627	diag = kdbgetintenv("COLUMNS", &colcount);
628	if (diag || colcount <= 1)
629		colcount = 80;
630
631	diag = kdbgetintenv("LOGGING", &logging);
632	if (diag)
633		logging = 0;
634
635	if (!kdb_grepping_flag || suspend_grep) {
636		/* normally, every vsnprintf starts a new buffer */
637		next_avail = kdb_buffer;
638		size_avail = sizeof(kdb_buffer);
639	}
640	vsnprintf(next_avail, size_avail, fmt, ap);
641
642	/*
643	 * If kdb_parse() found that the command was cmd xxx | grep yyy
644	 * then kdb_grepping_flag is set, and kdb_grep_string contains yyy
645	 *
646	 * Accumulate the print data up to a newline before searching it.
647	 * (vsnprintf does null-terminate the string that it generates)
648	 */
649
650	/* skip the search if prints are temporarily unconditional */
651	if (!suspend_grep && kdb_grepping_flag) {
652		cp = strchr(kdb_buffer, '\n');
653		if (!cp) {
654			/*
655			 * Special cases that don't end with newlines
656			 * but should be written without one:
657			 *   The "[nn]kdb> " prompt should
658			 *   appear at the front of the buffer.
659			 *
660			 *   The "[nn]more " prompt should also be
661			 *     (MOREPROMPT -> moreprompt)
662			 *   written *   but we print that ourselves,
663			 *   we set the suspend_grep flag to make
664			 *   it unconditional.
665			 *
666			 */
667			if (next_avail == kdb_buffer) {
668				/*
669				 * these should occur after a newline,
670				 * so they will be at the front of the
671				 * buffer
672				 */
673				cp2 = kdb_buffer;
674				len = strlen(kdb_prompt_str);
675				if (!strncmp(cp2, kdb_prompt_str, len)) {
676					/*
677					 * We're about to start a new
678					 * command, so we can go back
679					 * to normal mode.
680					 */
681					kdb_grepping_flag = 0;
682					goto kdb_printit;
683				}
684			}
685			/* no newline; don't search/write the buffer
686			   until one is there */
687			len = strlen(kdb_buffer);
688			next_avail = kdb_buffer + len;
689			size_avail = sizeof(kdb_buffer) - len;
690			goto kdb_print_out;
691		}
692
693		/*
694		 * The newline is present; print through it or discard
695		 * it, depending on the results of the search.
696		 */
697		cp++;	 	     /* to byte after the newline */
698		replaced_byte = *cp; /* remember what/where it was */
699		cphold = cp;
700		*cp = '\0';	     /* end the string for our search */
701
702		/*
703		 * We now have a newline at the end of the string
704		 * Only continue with this output if it contains the
705		 * search string.
706		 */
707		fnd = kdb_search_string(kdb_buffer, kdb_grep_string);
708		if (!fnd) {
709			/*
710			 * At this point the complete line at the start
711			 * of kdb_buffer can be discarded, as it does
712			 * not contain what the user is looking for.
713			 * Shift the buffer left.
714			 */
715			*cphold = replaced_byte;
716			strcpy(kdb_buffer, cphold);
717			len = strlen(kdb_buffer);
718			next_avail = kdb_buffer + len;
719			size_avail = sizeof(kdb_buffer) - len;
720			goto kdb_print_out;
721		}
722		if (kdb_grepping_flag >= KDB_GREPPING_FLAG_SEARCH) {
723			/*
724			 * This was a interactive search (using '/' at more
725			 * prompt) and it has completed. Replace the \0 with
726			 * its original value to ensure multi-line strings
727			 * are handled properly, and return to normal mode.
728			 */
729			*cphold = replaced_byte;
730			kdb_grepping_flag = 0;
731		}
732		/*
733		 * at this point the string is a full line and
734		 * should be printed, up to the null.
735		 */
736	}
737kdb_printit:
738
739	/*
740	 * Write to all consoles.
741	 */
742	retlen = strlen(kdb_buffer);
743	cp = (char *) printk_skip_headers(kdb_buffer);
744	if (!dbg_kdb_mode && kgdb_connected)
745		gdbstub_msg_write(cp, retlen - (cp - kdb_buffer));
746	else
747		kdb_msg_write(cp, retlen - (cp - kdb_buffer));
748
 
 
 
 
 
 
 
 
 
 
 
 
749	if (logging) {
750		saved_loglevel = console_loglevel;
751		console_loglevel = CONSOLE_LOGLEVEL_SILENT;
752		if (printk_get_level(kdb_buffer) || src == KDB_MSGSRC_PRINTK)
753			printk("%s", kdb_buffer);
754		else
755			pr_info("%s", kdb_buffer);
756	}
757
758	if (KDB_STATE(PAGER)) {
759		/*
760		 * Check printed string to decide how to bump the
761		 * kdb_nextline to control when the more prompt should
762		 * show up.
763		 */
764		int got = 0;
765		len = retlen;
766		while (len--) {
767			if (kdb_buffer[len] == '\n') {
768				kdb_nextline++;
769				got = 0;
770			} else if (kdb_buffer[len] == '\r') {
771				got = 0;
772			} else {
773				got++;
774			}
775		}
776		kdb_nextline += got / (colcount + 1);
777	}
778
779	/* check for having reached the LINES number of printed lines */
780	if (kdb_nextline >= linecount) {
781		char ch;
782
783		/* Watch out for recursion here.  Any routine that calls
784		 * kdb_printf will come back through here.  And kdb_read
785		 * uses kdb_printf to echo on serial consoles ...
786		 */
787		kdb_nextline = 1;	/* In case of recursion */
788
789		/*
790		 * Pause until cr.
791		 */
792		moreprompt = kdbgetenv("MOREPROMPT");
793		if (moreprompt == NULL)
794			moreprompt = "more> ";
795
796		kdb_input_flush();
797		kdb_msg_write(moreprompt, strlen(moreprompt));
 
 
 
 
 
 
 
 
 
 
 
 
 
 
798
799		if (logging)
800			printk("%s", moreprompt);
801
802		ch = kdb_getchar();
 
803		kdb_nextline = 1;	/* Really set output line 1 */
804
805		/* empty and reset the buffer: */
806		kdb_buffer[0] = '\0';
807		next_avail = kdb_buffer;
808		size_avail = sizeof(kdb_buffer);
809		if ((ch == 'q') || (ch == 'Q')) {
810			/* user hit q or Q */
811			KDB_FLAG_SET(CMD_INTERRUPT); /* command interrupted */
812			KDB_STATE_CLEAR(PAGER);
813			/* end of command output; back to normal mode */
814			kdb_grepping_flag = 0;
815			kdb_printf("\n");
816		} else if (ch == ' ') {
817			kdb_printf("\r");
818			suspend_grep = 1; /* for this recursion */
819		} else if (ch == '\n' || ch == '\r') {
820			kdb_nextline = linecount - 1;
821			kdb_printf("\r");
822			suspend_grep = 1; /* for this recursion */
823		} else if (ch == '/' && !kdb_grepping_flag) {
824			kdb_printf("\r");
825			kdb_getstr(kdb_grep_string, KDB_GREP_STRLEN,
826				   kdbgetenv("SEARCHPROMPT") ?: "search> ");
827			*strchrnul(kdb_grep_string, '\n') = '\0';
828			kdb_grepping_flag += KDB_GREPPING_FLAG_SEARCH;
829			suspend_grep = 1; /* for this recursion */
830		} else if (ch) {
831			/* user hit something unexpected */
832			suspend_grep = 1; /* for this recursion */
833			if (ch != '/')
834				kdb_printf(
835				    "\nOnly 'q', 'Q' or '/' are processed at "
836				    "more prompt, input ignored\n");
837			else
838				kdb_printf("\n'/' cannot be used during | "
839					   "grep filtering, input ignored\n");
840		} else if (kdb_grepping_flag) {
841			/* user hit enter */
842			suspend_grep = 1; /* for this recursion */
843			kdb_printf("\n");
844		}
845		kdb_input_flush();
846	}
847
848	/*
849	 * For grep searches, shift the printed string left.
850	 *  replaced_byte contains the character that was overwritten with
851	 *  the terminating null, and cphold points to the null.
852	 * Then adjust the notion of available space in the buffer.
853	 */
854	if (kdb_grepping_flag && !suspend_grep) {
855		*cphold = replaced_byte;
856		strcpy(kdb_buffer, cphold);
857		len = strlen(kdb_buffer);
858		next_avail = kdb_buffer + len;
859		size_avail = sizeof(kdb_buffer) - len;
860	}
861
862kdb_print_out:
863	suspend_grep = 0; /* end of what may have been a recursive call */
864	if (logging)
865		console_loglevel = saved_loglevel;
866	/* kdb_printf_cpu locked the code above. */
867	smp_store_release(&kdb_printf_cpu, old_cpu);
868	local_irq_restore(flags);
869	return retlen;
870}
871
872int kdb_printf(const char *fmt, ...)
873{
874	va_list ap;
875	int r;
876
877	va_start(ap, fmt);
878	r = vkdb_printf(KDB_MSGSRC_INTERNAL, fmt, ap);
879	va_end(ap);
880
881	return r;
882}
883EXPORT_SYMBOL_GPL(kdb_printf);
v5.4
  1/*
  2 * Kernel Debugger Architecture Independent Console I/O handler
  3 *
  4 * This file is subject to the terms and conditions of the GNU General Public
  5 * License.  See the file "COPYING" in the main directory of this archive
  6 * for more details.
  7 *
  8 * Copyright (c) 1999-2006 Silicon Graphics, Inc.  All Rights Reserved.
  9 * Copyright (c) 2009 Wind River Systems, Inc.  All Rights Reserved.
 10 */
 11
 12#include <linux/module.h>
 13#include <linux/types.h>
 14#include <linux/ctype.h>
 15#include <linux/kernel.h>
 16#include <linux/init.h>
 17#include <linux/kdev_t.h>
 18#include <linux/console.h>
 19#include <linux/string.h>
 20#include <linux/sched.h>
 21#include <linux/smp.h>
 22#include <linux/nmi.h>
 23#include <linux/delay.h>
 24#include <linux/kgdb.h>
 25#include <linux/kdb.h>
 26#include <linux/kallsyms.h>
 27#include "kdb_private.h"
 28
 29#define CMD_BUFLEN 256
 30char kdb_prompt_str[CMD_BUFLEN];
 31
 32int kdb_trap_printk;
 33int kdb_printf_cpu = -1;
 34
 35static int kgdb_transition_check(char *buffer)
 36{
 37	if (buffer[0] != '+' && buffer[0] != '$') {
 38		KDB_STATE_SET(KGDB_TRANS);
 39		kdb_printf("%s", buffer);
 40	} else {
 41		int slen = strlen(buffer);
 42		if (slen > 3 && buffer[slen - 3] == '#') {
 43			kdb_gdb_state_pass(buffer);
 44			strcpy(buffer, "kgdb");
 45			KDB_STATE_SET(DOING_KGDB);
 46			return 1;
 47		}
 48	}
 49	return 0;
 50}
 51
 52static int kdb_read_get_key(char *buffer, size_t bufsize)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 53{
 54#define ESCAPE_UDELAY 1000
 55#define ESCAPE_DELAY (2*1000000/ESCAPE_UDELAY) /* 2 seconds worth of udelays */
 56	char escape_data[5];	/* longest vt100 escape sequence is 4 bytes */
 57	char *ped = escape_data;
 58	int escape_delay = 0;
 59	get_char_func *f, *f_escape = NULL;
 60	int key;
 61
 62	for (f = &kdb_poll_funcs[0]; ; ++f) {
 63		if (*f == NULL) {
 64			/* Reset NMI watchdog once per poll loop */
 65			touch_nmi_watchdog();
 66			f = &kdb_poll_funcs[0];
 67		}
 68		if (escape_delay == 2) {
 69			*ped = '\0';
 70			ped = escape_data;
 71			--escape_delay;
 72		}
 73		if (escape_delay == 1) {
 74			key = *ped++;
 75			if (!*ped)
 76				--escape_delay;
 77			break;
 78		}
 79		key = (*f)();
 80		if (key == -1) {
 81			if (escape_delay) {
 82				udelay(ESCAPE_UDELAY);
 83				--escape_delay;
 
 84			}
 85			continue;
 86		}
 87		if (bufsize <= 2) {
 88			if (key == '\r')
 89				key = '\n';
 90			*buffer++ = key;
 91			*buffer = '\0';
 92			return -1;
 93		}
 94		if (escape_delay == 0 && key == '\e') {
 
 95			escape_delay = ESCAPE_DELAY;
 96			ped = escape_data;
 97			f_escape = f;
 98		}
 99		if (escape_delay) {
100			*ped++ = key;
101			if (f_escape != f) {
102				escape_delay = 2;
103				continue;
104			}
105			if (ped - escape_data == 1) {
106				/* \e */
107				continue;
108			} else if (ped - escape_data == 2) {
109				/* \e<something> */
110				if (key != '[')
111					escape_delay = 2;
112				continue;
113			} else if (ped - escape_data == 3) {
114				/* \e[<something> */
115				int mapkey = 0;
116				switch (key) {
117				case 'A': /* \e[A, up arrow */
118					mapkey = 16;
119					break;
120				case 'B': /* \e[B, down arrow */
121					mapkey = 14;
122					break;
123				case 'C': /* \e[C, right arrow */
124					mapkey = 6;
125					break;
126				case 'D': /* \e[D, left arrow */
127					mapkey = 2;
128					break;
129				case '1': /* dropthrough */
130				case '3': /* dropthrough */
131				/* \e[<1,3,4>], may be home, del, end */
132				case '4':
133					mapkey = -1;
134					break;
135				}
136				if (mapkey != -1) {
137					if (mapkey > 0) {
138						escape_data[0] = mapkey;
139						escape_data[1] = '\0';
140					}
141					escape_delay = 2;
142				}
143				continue;
144			} else if (ped - escape_data == 4) {
145				/* \e[<1,3,4><something> */
146				int mapkey = 0;
147				if (key == '~') {
148					switch (escape_data[2]) {
149					case '1': /* \e[1~, home */
150						mapkey = 1;
151						break;
152					case '3': /* \e[3~, del */
153						mapkey = 4;
154						break;
155					case '4': /* \e[4~, end */
156						mapkey = 5;
157						break;
158					}
159				}
160				if (mapkey > 0) {
161					escape_data[0] = mapkey;
162					escape_data[1] = '\0';
163				}
164				escape_delay = 2;
165				continue;
166			}
167		}
168		break;	/* A key to process */
169	}
170	return key;
 
171}
172
173/*
174 * kdb_read
175 *
176 *	This function reads a string of characters, terminated by
177 *	a newline, or by reaching the end of the supplied buffer,
178 *	from the current kernel debugger console device.
179 * Parameters:
180 *	buffer	- Address of character buffer to receive input characters.
181 *	bufsize - size, in bytes, of the character buffer
182 * Returns:
183 *	Returns a pointer to the buffer containing the received
184 *	character string.  This string will be terminated by a
185 *	newline character.
186 * Locking:
187 *	No locks are required to be held upon entry to this
188 *	function.  It is not reentrant - it relies on the fact
189 *	that while kdb is running on only one "master debug" cpu.
190 * Remarks:
191 *
192 * The buffer size must be >= 2.  A buffer size of 2 means that the caller only
193 * wants a single key.
194 *
195 * An escape key could be the start of a vt100 control sequence such as \e[D
196 * (left arrow) or it could be a character in its own right.  The standard
197 * method for detecting the difference is to wait for 2 seconds to see if there
198 * are any other characters.  kdb is complicated by the lack of a timer service
199 * (interrupts are off), by multiple input sources and by the need to sometimes
200 * return after just one key.  Escape sequence processing has to be done as
201 * states in the polling loop.
202 */
203
204static char *kdb_read(char *buffer, size_t bufsize)
205{
206	char *cp = buffer;
207	char *bufend = buffer+bufsize-2;	/* Reserve space for newline
208						 * and null byte */
209	char *lastchar;
210	char *p_tmp;
211	char tmp;
212	static char tmpbuffer[CMD_BUFLEN];
213	int len = strlen(buffer);
214	int len_tmp;
215	int tab = 0;
216	int count;
217	int i;
218	int diag, dtab_count;
219	int key, buf_size, ret;
220
221
222	diag = kdbgetintenv("DTABCOUNT", &dtab_count);
223	if (diag)
224		dtab_count = 30;
225
226	if (len > 0) {
227		cp += len;
228		if (*(buffer+len-1) == '\n')
229			cp--;
230	}
231
232	lastchar = cp;
233	*cp = '\0';
234	kdb_printf("%s", buffer);
235poll_again:
236	key = kdb_read_get_key(buffer, bufsize);
237	if (key == -1)
238		return buffer;
239	if (key != 9)
240		tab = 0;
241	switch (key) {
242	case 8: /* backspace */
243		if (cp > buffer) {
244			if (cp < lastchar) {
245				memcpy(tmpbuffer, cp, lastchar - cp);
246				memcpy(cp-1, tmpbuffer, lastchar - cp);
247			}
248			*(--lastchar) = '\0';
249			--cp;
250			kdb_printf("\b%s \r", cp);
251			tmp = *cp;
252			*cp = '\0';
253			kdb_printf(kdb_prompt_str);
254			kdb_printf("%s", buffer);
255			*cp = tmp;
256		}
257		break;
258	case 13: /* enter */
259		*lastchar++ = '\n';
260		*lastchar++ = '\0';
261		if (!KDB_STATE(KGDB_TRANS)) {
262			KDB_STATE_SET(KGDB_TRANS);
263			kdb_printf("%s", buffer);
264		}
265		kdb_printf("\n");
266		return buffer;
267	case 4: /* Del */
268		if (cp < lastchar) {
269			memcpy(tmpbuffer, cp+1, lastchar - cp - 1);
270			memcpy(cp, tmpbuffer, lastchar - cp - 1);
271			*(--lastchar) = '\0';
272			kdb_printf("%s \r", cp);
273			tmp = *cp;
274			*cp = '\0';
275			kdb_printf(kdb_prompt_str);
276			kdb_printf("%s", buffer);
277			*cp = tmp;
278		}
279		break;
280	case 1: /* Home */
281		if (cp > buffer) {
282			kdb_printf("\r");
283			kdb_printf(kdb_prompt_str);
284			cp = buffer;
285		}
286		break;
287	case 5: /* End */
288		if (cp < lastchar) {
289			kdb_printf("%s", cp);
290			cp = lastchar;
291		}
292		break;
293	case 2: /* Left */
294		if (cp > buffer) {
295			kdb_printf("\b");
296			--cp;
297		}
298		break;
299	case 14: /* Down */
300		memset(tmpbuffer, ' ',
301		       strlen(kdb_prompt_str) + (lastchar-buffer));
302		*(tmpbuffer+strlen(kdb_prompt_str) +
303		  (lastchar-buffer)) = '\0';
304		kdb_printf("\r%s\r", tmpbuffer);
305		*lastchar = (char)key;
306		*(lastchar+1) = '\0';
307		return lastchar;
308	case 6: /* Right */
309		if (cp < lastchar) {
310			kdb_printf("%c", *cp);
311			++cp;
312		}
313		break;
314	case 16: /* Up */
315		memset(tmpbuffer, ' ',
316		       strlen(kdb_prompt_str) + (lastchar-buffer));
317		*(tmpbuffer+strlen(kdb_prompt_str) +
318		  (lastchar-buffer)) = '\0';
319		kdb_printf("\r%s\r", tmpbuffer);
320		*lastchar = (char)key;
321		*(lastchar+1) = '\0';
322		return lastchar;
323	case 9: /* Tab */
324		if (tab < 2)
325			++tab;
326		p_tmp = buffer;
327		while (*p_tmp == ' ')
328			p_tmp++;
329		if (p_tmp > cp)
330			break;
331		memcpy(tmpbuffer, p_tmp, cp-p_tmp);
332		*(tmpbuffer + (cp-p_tmp)) = '\0';
333		p_tmp = strrchr(tmpbuffer, ' ');
334		if (p_tmp)
335			++p_tmp;
336		else
337			p_tmp = tmpbuffer;
338		len = strlen(p_tmp);
339		buf_size = sizeof(tmpbuffer) - (p_tmp - tmpbuffer);
340		count = kallsyms_symbol_complete(p_tmp, buf_size);
341		if (tab == 2 && count > 0) {
342			kdb_printf("\n%d symbols are found.", count);
343			if (count > dtab_count) {
344				count = dtab_count;
345				kdb_printf(" But only first %d symbols will"
346					   " be printed.\nYou can change the"
347					   " environment variable DTABCOUNT.",
348					   count);
349			}
350			kdb_printf("\n");
351			for (i = 0; i < count; i++) {
352				ret = kallsyms_symbol_next(p_tmp, i, buf_size);
353				if (WARN_ON(!ret))
354					break;
355				if (ret != -E2BIG)
356					kdb_printf("%s ", p_tmp);
357				else
358					kdb_printf("%s... ", p_tmp);
359				*(p_tmp + len) = '\0';
360			}
361			if (i >= dtab_count)
362				kdb_printf("...");
363			kdb_printf("\n");
364			kdb_printf(kdb_prompt_str);
365			kdb_printf("%s", buffer);
366		} else if (tab != 2 && count > 0) {
367			len_tmp = strlen(p_tmp);
368			strncpy(p_tmp+len_tmp, cp, lastchar-cp+1);
369			len_tmp = strlen(p_tmp);
370			strncpy(cp, p_tmp+len, len_tmp-len + 1);
371			len = len_tmp - len;
372			kdb_printf("%s", cp);
373			cp += len;
374			lastchar += len;
375		}
376		kdb_nextline = 1; /* reset output line number */
377		break;
378	default:
379		if (key >= 32 && lastchar < bufend) {
380			if (cp < lastchar) {
381				memcpy(tmpbuffer, cp, lastchar - cp);
382				memcpy(cp+1, tmpbuffer, lastchar - cp);
383				*++lastchar = '\0';
384				*cp = key;
385				kdb_printf("%s\r", cp);
386				++cp;
387				tmp = *cp;
388				*cp = '\0';
389				kdb_printf(kdb_prompt_str);
390				kdb_printf("%s", buffer);
391				*cp = tmp;
392			} else {
393				*++lastchar = '\0';
394				*cp++ = key;
395				/* The kgdb transition check will hide
396				 * printed characters if we think that
397				 * kgdb is connecting, until the check
398				 * fails */
399				if (!KDB_STATE(KGDB_TRANS)) {
400					if (kgdb_transition_check(buffer))
401						return buffer;
402				} else {
403					kdb_printf("%c", key);
404				}
405			}
406			/* Special escape to kgdb */
407			if (lastchar - buffer >= 5 &&
408			    strcmp(lastchar - 5, "$?#3f") == 0) {
409				kdb_gdb_state_pass(lastchar - 5);
410				strcpy(buffer, "kgdb");
411				KDB_STATE_SET(DOING_KGDB);
412				return buffer;
413			}
414			if (lastchar - buffer >= 11 &&
415			    strcmp(lastchar - 11, "$qSupported") == 0) {
416				kdb_gdb_state_pass(lastchar - 11);
417				strcpy(buffer, "kgdb");
418				KDB_STATE_SET(DOING_KGDB);
419				return buffer;
420			}
421		}
422		break;
423	}
424	goto poll_again;
425}
426
427/*
428 * kdb_getstr
429 *
430 *	Print the prompt string and read a command from the
431 *	input device.
432 *
433 * Parameters:
434 *	buffer	Address of buffer to receive command
435 *	bufsize Size of buffer in bytes
436 *	prompt	Pointer to string to use as prompt string
437 * Returns:
438 *	Pointer to command buffer.
439 * Locking:
440 *	None.
441 * Remarks:
442 *	For SMP kernels, the processor number will be
443 *	substituted for %d, %x or %o in the prompt.
444 */
445
446char *kdb_getstr(char *buffer, size_t bufsize, const char *prompt)
447{
448	if (prompt && kdb_prompt_str != prompt)
449		strscpy(kdb_prompt_str, prompt, CMD_BUFLEN);
450	kdb_printf(kdb_prompt_str);
451	kdb_nextline = 1;	/* Prompt and input resets line number */
452	return kdb_read(buffer, bufsize);
453}
454
455/*
456 * kdb_input_flush
457 *
458 *	Get rid of any buffered console input.
459 *
460 * Parameters:
461 *	none
462 * Returns:
463 *	nothing
464 * Locking:
465 *	none
466 * Remarks:
467 *	Call this function whenever you want to flush input.  If there is any
468 *	outstanding input, it ignores all characters until there has been no
469 *	data for approximately 1ms.
470 */
471
472static void kdb_input_flush(void)
473{
474	get_char_func *f;
475	int res;
476	int flush_delay = 1;
477	while (flush_delay) {
478		flush_delay--;
479empty:
480		touch_nmi_watchdog();
481		for (f = &kdb_poll_funcs[0]; *f; ++f) {
482			res = (*f)();
483			if (res != -1) {
484				flush_delay = 1;
485				goto empty;
486			}
487		}
488		if (flush_delay)
489			mdelay(1);
490	}
491}
492
493/*
494 * kdb_printf
495 *
496 *	Print a string to the output device(s).
497 *
498 * Parameters:
499 *	printf-like format and optional args.
500 * Returns:
501 *	0
502 * Locking:
503 *	None.
504 * Remarks:
505 *	use 'kdbcons->write()' to avoid polluting 'log_buf' with
506 *	kdb output.
507 *
508 *  If the user is doing a cmd args | grep srch
509 *  then kdb_grepping_flag is set.
510 *  In that case we need to accumulate full lines (ending in \n) before
511 *  searching for the pattern.
512 */
513
514static char kdb_buffer[256];	/* A bit too big to go on stack */
515static char *next_avail = kdb_buffer;
516static int  size_avail;
517static int  suspend_grep;
518
519/*
520 * search arg1 to see if it contains arg2
521 * (kdmain.c provides flags for ^pat and pat$)
522 *
523 * return 1 for found, 0 for not found
524 */
525static int kdb_search_string(char *searched, char *searchfor)
526{
527	char firstchar, *cp;
528	int len1, len2;
529
530	/* not counting the newline at the end of "searched" */
531	len1 = strlen(searched)-1;
532	len2 = strlen(searchfor);
533	if (len1 < len2)
534		return 0;
535	if (kdb_grep_leading && kdb_grep_trailing && len1 != len2)
536		return 0;
537	if (kdb_grep_leading) {
538		if (!strncmp(searched, searchfor, len2))
539			return 1;
540	} else if (kdb_grep_trailing) {
541		if (!strncmp(searched+len1-len2, searchfor, len2))
542			return 1;
543	} else {
544		firstchar = *searchfor;
545		cp = searched;
546		while ((cp = strchr(cp, firstchar))) {
547			if (!strncmp(cp, searchfor, len2))
548				return 1;
549			cp++;
550		}
551	}
552	return 0;
553}
554
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
555int vkdb_printf(enum kdb_msgsrc src, const char *fmt, va_list ap)
556{
557	int diag;
558	int linecount;
559	int colcount;
560	int logging, saved_loglevel = 0;
561	int retlen = 0;
562	int fnd, len;
563	int this_cpu, old_cpu;
564	char *cp, *cp2, *cphold = NULL, replaced_byte = ' ';
565	char *moreprompt = "more> ";
566	struct console *c = console_drivers;
567	unsigned long uninitialized_var(flags);
568
569	/* Serialize kdb_printf if multiple cpus try to write at once.
570	 * But if any cpu goes recursive in kdb, just print the output,
571	 * even if it is interleaved with any other text.
572	 */
573	local_irq_save(flags);
574	this_cpu = smp_processor_id();
575	for (;;) {
576		old_cpu = cmpxchg(&kdb_printf_cpu, -1, this_cpu);
577		if (old_cpu == -1 || old_cpu == this_cpu)
578			break;
579
580		cpu_relax();
581	}
582
583	diag = kdbgetintenv("LINES", &linecount);
584	if (diag || linecount <= 1)
585		linecount = 24;
586
587	diag = kdbgetintenv("COLUMNS", &colcount);
588	if (diag || colcount <= 1)
589		colcount = 80;
590
591	diag = kdbgetintenv("LOGGING", &logging);
592	if (diag)
593		logging = 0;
594
595	if (!kdb_grepping_flag || suspend_grep) {
596		/* normally, every vsnprintf starts a new buffer */
597		next_avail = kdb_buffer;
598		size_avail = sizeof(kdb_buffer);
599	}
600	vsnprintf(next_avail, size_avail, fmt, ap);
601
602	/*
603	 * If kdb_parse() found that the command was cmd xxx | grep yyy
604	 * then kdb_grepping_flag is set, and kdb_grep_string contains yyy
605	 *
606	 * Accumulate the print data up to a newline before searching it.
607	 * (vsnprintf does null-terminate the string that it generates)
608	 */
609
610	/* skip the search if prints are temporarily unconditional */
611	if (!suspend_grep && kdb_grepping_flag) {
612		cp = strchr(kdb_buffer, '\n');
613		if (!cp) {
614			/*
615			 * Special cases that don't end with newlines
616			 * but should be written without one:
617			 *   The "[nn]kdb> " prompt should
618			 *   appear at the front of the buffer.
619			 *
620			 *   The "[nn]more " prompt should also be
621			 *     (MOREPROMPT -> moreprompt)
622			 *   written *   but we print that ourselves,
623			 *   we set the suspend_grep flag to make
624			 *   it unconditional.
625			 *
626			 */
627			if (next_avail == kdb_buffer) {
628				/*
629				 * these should occur after a newline,
630				 * so they will be at the front of the
631				 * buffer
632				 */
633				cp2 = kdb_buffer;
634				len = strlen(kdb_prompt_str);
635				if (!strncmp(cp2, kdb_prompt_str, len)) {
636					/*
637					 * We're about to start a new
638					 * command, so we can go back
639					 * to normal mode.
640					 */
641					kdb_grepping_flag = 0;
642					goto kdb_printit;
643				}
644			}
645			/* no newline; don't search/write the buffer
646			   until one is there */
647			len = strlen(kdb_buffer);
648			next_avail = kdb_buffer + len;
649			size_avail = sizeof(kdb_buffer) - len;
650			goto kdb_print_out;
651		}
652
653		/*
654		 * The newline is present; print through it or discard
655		 * it, depending on the results of the search.
656		 */
657		cp++;	 	     /* to byte after the newline */
658		replaced_byte = *cp; /* remember what/where it was */
659		cphold = cp;
660		*cp = '\0';	     /* end the string for our search */
661
662		/*
663		 * We now have a newline at the end of the string
664		 * Only continue with this output if it contains the
665		 * search string.
666		 */
667		fnd = kdb_search_string(kdb_buffer, kdb_grep_string);
668		if (!fnd) {
669			/*
670			 * At this point the complete line at the start
671			 * of kdb_buffer can be discarded, as it does
672			 * not contain what the user is looking for.
673			 * Shift the buffer left.
674			 */
675			*cphold = replaced_byte;
676			strcpy(kdb_buffer, cphold);
677			len = strlen(kdb_buffer);
678			next_avail = kdb_buffer + len;
679			size_avail = sizeof(kdb_buffer) - len;
680			goto kdb_print_out;
681		}
682		if (kdb_grepping_flag >= KDB_GREPPING_FLAG_SEARCH)
683			/*
684			 * This was a interactive search (using '/' at more
685			 * prompt) and it has completed. Clear the flag.
 
 
686			 */
 
687			kdb_grepping_flag = 0;
 
688		/*
689		 * at this point the string is a full line and
690		 * should be printed, up to the null.
691		 */
692	}
693kdb_printit:
694
695	/*
696	 * Write to all consoles.
697	 */
698	retlen = strlen(kdb_buffer);
699	cp = (char *) printk_skip_headers(kdb_buffer);
700	if (!dbg_kdb_mode && kgdb_connected) {
701		gdbstub_msg_write(cp, retlen - (cp - kdb_buffer));
702	} else {
703		if (dbg_io_ops && !dbg_io_ops->is_console) {
704			len = retlen - (cp - kdb_buffer);
705			cp2 = cp;
706			while (len--) {
707				dbg_io_ops->write_char(*cp2);
708				cp2++;
709			}
710		}
711		while (c) {
712			c->write(c, cp, retlen - (cp - kdb_buffer));
713			touch_nmi_watchdog();
714			c = c->next;
715		}
716	}
717	if (logging) {
718		saved_loglevel = console_loglevel;
719		console_loglevel = CONSOLE_LOGLEVEL_SILENT;
720		if (printk_get_level(kdb_buffer) || src == KDB_MSGSRC_PRINTK)
721			printk("%s", kdb_buffer);
722		else
723			pr_info("%s", kdb_buffer);
724	}
725
726	if (KDB_STATE(PAGER)) {
727		/*
728		 * Check printed string to decide how to bump the
729		 * kdb_nextline to control when the more prompt should
730		 * show up.
731		 */
732		int got = 0;
733		len = retlen;
734		while (len--) {
735			if (kdb_buffer[len] == '\n') {
736				kdb_nextline++;
737				got = 0;
738			} else if (kdb_buffer[len] == '\r') {
739				got = 0;
740			} else {
741				got++;
742			}
743		}
744		kdb_nextline += got / (colcount + 1);
745	}
746
747	/* check for having reached the LINES number of printed lines */
748	if (kdb_nextline >= linecount) {
749		char buf1[16] = "";
750
751		/* Watch out for recursion here.  Any routine that calls
752		 * kdb_printf will come back through here.  And kdb_read
753		 * uses kdb_printf to echo on serial consoles ...
754		 */
755		kdb_nextline = 1;	/* In case of recursion */
756
757		/*
758		 * Pause until cr.
759		 */
760		moreprompt = kdbgetenv("MOREPROMPT");
761		if (moreprompt == NULL)
762			moreprompt = "more> ";
763
764		kdb_input_flush();
765		c = console_drivers;
766
767		if (dbg_io_ops && !dbg_io_ops->is_console) {
768			len = strlen(moreprompt);
769			cp = moreprompt;
770			while (len--) {
771				dbg_io_ops->write_char(*cp);
772				cp++;
773			}
774		}
775		while (c) {
776			c->write(c, moreprompt, strlen(moreprompt));
777			touch_nmi_watchdog();
778			c = c->next;
779		}
780
781		if (logging)
782			printk("%s", moreprompt);
783
784		kdb_read(buf1, 2); /* '2' indicates to return
785				    * immediately after getting one key. */
786		kdb_nextline = 1;	/* Really set output line 1 */
787
788		/* empty and reset the buffer: */
789		kdb_buffer[0] = '\0';
790		next_avail = kdb_buffer;
791		size_avail = sizeof(kdb_buffer);
792		if ((buf1[0] == 'q') || (buf1[0] == 'Q')) {
793			/* user hit q or Q */
794			KDB_FLAG_SET(CMD_INTERRUPT); /* command interrupted */
795			KDB_STATE_CLEAR(PAGER);
796			/* end of command output; back to normal mode */
797			kdb_grepping_flag = 0;
798			kdb_printf("\n");
799		} else if (buf1[0] == ' ') {
800			kdb_printf("\r");
801			suspend_grep = 1; /* for this recursion */
802		} else if (buf1[0] == '\n') {
803			kdb_nextline = linecount - 1;
804			kdb_printf("\r");
805			suspend_grep = 1; /* for this recursion */
806		} else if (buf1[0] == '/' && !kdb_grepping_flag) {
807			kdb_printf("\r");
808			kdb_getstr(kdb_grep_string, KDB_GREP_STRLEN,
809				   kdbgetenv("SEARCHPROMPT") ?: "search> ");
810			*strchrnul(kdb_grep_string, '\n') = '\0';
811			kdb_grepping_flag += KDB_GREPPING_FLAG_SEARCH;
812			suspend_grep = 1; /* for this recursion */
813		} else if (buf1[0] && buf1[0] != '\n') {
814			/* user hit something other than enter */
815			suspend_grep = 1; /* for this recursion */
816			if (buf1[0] != '/')
817				kdb_printf(
818				    "\nOnly 'q', 'Q' or '/' are processed at "
819				    "more prompt, input ignored\n");
820			else
821				kdb_printf("\n'/' cannot be used during | "
822					   "grep filtering, input ignored\n");
823		} else if (kdb_grepping_flag) {
824			/* user hit enter */
825			suspend_grep = 1; /* for this recursion */
826			kdb_printf("\n");
827		}
828		kdb_input_flush();
829	}
830
831	/*
832	 * For grep searches, shift the printed string left.
833	 *  replaced_byte contains the character that was overwritten with
834	 *  the terminating null, and cphold points to the null.
835	 * Then adjust the notion of available space in the buffer.
836	 */
837	if (kdb_grepping_flag && !suspend_grep) {
838		*cphold = replaced_byte;
839		strcpy(kdb_buffer, cphold);
840		len = strlen(kdb_buffer);
841		next_avail = kdb_buffer + len;
842		size_avail = sizeof(kdb_buffer) - len;
843	}
844
845kdb_print_out:
846	suspend_grep = 0; /* end of what may have been a recursive call */
847	if (logging)
848		console_loglevel = saved_loglevel;
849	/* kdb_printf_cpu locked the code above. */
850	smp_store_release(&kdb_printf_cpu, old_cpu);
851	local_irq_restore(flags);
852	return retlen;
853}
854
855int kdb_printf(const char *fmt, ...)
856{
857	va_list ap;
858	int r;
859
860	va_start(ap, fmt);
861	r = vkdb_printf(KDB_MSGSRC_INTERNAL, fmt, ap);
862	va_end(ap);
863
864	return r;
865}
866EXPORT_SYMBOL_GPL(kdb_printf);