LCOV - code coverage report
Current view: top level - kernel/debug/kdb - kdb_io.c (source / functions) Hit Total Coverage
Test: Real Lines: 0 363 0.0 %
Date: 2020-10-17 15:46:16 Functions: 0 8 0.0 %
Legend: Neither, QEMU, Real, Both Branches: 0 0 -

           Branch data     Line data    Source code
       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
      30                 :            : char kdb_prompt_str[CMD_BUFLEN];
      31                 :            : 
      32                 :            : int kdb_trap_printk;
      33                 :            : int kdb_printf_cpu = -1;
      34                 :            : 
      35                 :          0 : static int kgdb_transition_check(char *buffer)
      36                 :            : {
      37                 :          0 :         if (buffer[0] != '+' && buffer[0] != '$') {
      38                 :          0 :                 KDB_STATE_SET(KGDB_TRANS);
      39                 :          0 :                 kdb_printf("%s", buffer);
      40                 :            :         } else {
      41                 :          0 :                 int slen = strlen(buffer);
      42                 :          0 :                 if (slen > 3 && buffer[slen - 3] == '#') {
      43                 :          0 :                         kdb_gdb_state_pass(buffer);
      44                 :          0 :                         strcpy(buffer, "kgdb");
      45                 :          0 :                         KDB_STATE_SET(DOING_KGDB);
      46                 :          0 :                         return 1;
      47                 :            :                 }
      48                 :            :         }
      49                 :            :         return 0;
      50                 :            : }
      51                 :            : 
      52                 :          0 : static 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                 :          0 :         for (f = &kdb_poll_funcs[0]; ; ++f) {
      63                 :          0 :                 if (*f == NULL) {
      64                 :            :                         /* Reset NMI watchdog once per poll loop */
      65                 :            :                         touch_nmi_watchdog();
      66                 :            :                         f = &kdb_poll_funcs[0];
      67                 :            :                 }
      68                 :          0 :                 if (escape_delay == 2) {
      69                 :          0 :                         *ped = '\0';
      70                 :            :                         ped = escape_data;
      71                 :          0 :                         --escape_delay;
      72                 :            :                 }
      73                 :          0 :                 if (escape_delay == 1) {
      74                 :          0 :                         key = *ped++;
      75                 :            :                         if (!*ped)
      76                 :            :                                 --escape_delay;
      77                 :            :                         break;
      78                 :            :                 }
      79                 :          0 :                 key = (*f)();
      80                 :          0 :                 if (key == -1) {
      81                 :          0 :                         if (escape_delay) {
      82                 :          0 :                                 udelay(ESCAPE_UDELAY);
      83                 :          0 :                                 --escape_delay;
      84                 :            :                         }
      85                 :          0 :                         continue;
      86                 :            :                 }
      87                 :          0 :                 if (bufsize <= 2) {
      88                 :          0 :                         if (key == '\r')
      89                 :            :                                 key = '\n';
      90                 :          0 :                         *buffer++ = key;
      91                 :          0 :                         *buffer = '\0';
      92                 :          0 :                         return -1;
      93                 :            :                 }
      94                 :          0 :                 if (escape_delay == 0 && key == '\e') {
      95                 :            :                         escape_delay = ESCAPE_DELAY;
      96                 :            :                         ped = escape_data;
      97                 :            :                         f_escape = f;
      98                 :            :                 }
      99                 :          0 :                 if (escape_delay) {
     100                 :          0 :                         *ped++ = key;
     101                 :          0 :                         if (f_escape != f) {
     102                 :            :                                 escape_delay = 2;
     103                 :          0 :                                 continue;
     104                 :            :                         }
     105                 :          0 :                         if (ped - escape_data == 1) {
     106                 :            :                                 /* \e */
     107                 :          0 :                                 continue;
     108                 :          0 :                         } else if (ped - escape_data == 2) {
     109                 :            :                                 /* \e<something> */
     110                 :          0 :                                 if (key != '[')
     111                 :            :                                         escape_delay = 2;
     112                 :          0 :                                 continue;
     113                 :          0 :                         } else if (ped - escape_data == 3) {
     114                 :            :                                 /* \e[<something> */
     115                 :            :                                 int mapkey = 0;
     116                 :          0 :                                 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                 :          0 :                                 if (mapkey != -1) {
     137                 :          0 :                                         if (mapkey > 0) {
     138                 :          0 :                                                 escape_data[0] = mapkey;
     139                 :          0 :                                                 escape_data[1] = '\0';
     140                 :            :                                         }
     141                 :            :                                         escape_delay = 2;
     142                 :            :                                 }
     143                 :          0 :                                 continue;
     144                 :          0 :                         } else if (ped - escape_data == 4) {
     145                 :            :                                 /* \e[<1,3,4><something> */
     146                 :            :                                 int mapkey = 0;
     147                 :          0 :                                 if (key == '~') {
     148                 :          0 :                                         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                 :          0 :                                 if (mapkey > 0) {
     161                 :          0 :                                         escape_data[0] = mapkey;
     162                 :          0 :                                         escape_data[1] = '\0';
     163                 :            :                                 }
     164                 :            :                                 escape_delay = 2;
     165                 :          0 :                                 continue;
     166                 :            :                         }
     167                 :            :                 }
     168                 :            :                 break;  /* A key to process */
     169                 :          0 :         }
     170                 :          0 :         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                 :            : 
     204                 :          0 : static char *kdb_read(char *buffer, size_t bufsize)
     205                 :            : {
     206                 :            :         char *cp = buffer;
     207                 :          0 :         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                 :          0 :         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                 :          0 :         diag = kdbgetintenv("DTABCOUNT", &dtab_count);
     223                 :          0 :         if (diag)
     224                 :          0 :                 dtab_count = 30;
     225                 :            : 
     226                 :          0 :         if (len > 0) {
     227                 :          0 :                 cp += len;
     228                 :          0 :                 if (*(buffer+len-1) == '\n')
     229                 :          0 :                         cp--;
     230                 :            :         }
     231                 :            : 
     232                 :            :         lastchar = cp;
     233                 :          0 :         *cp = '\0';
     234                 :          0 :         kdb_printf("%s", buffer);
     235                 :            : poll_again:
     236                 :          0 :         key = kdb_read_get_key(buffer, bufsize);
     237                 :          0 :         if (key == -1)
     238                 :            :                 return buffer;
     239                 :          0 :         if (key != 9)
     240                 :            :                 tab = 0;
     241                 :          0 :         switch (key) {
     242                 :            :         case 8: /* backspace */
     243                 :          0 :                 if (cp > buffer) {
     244                 :          0 :                         if (cp < lastchar) {
     245                 :          0 :                                 memcpy(tmpbuffer, cp, lastchar - cp);
     246                 :          0 :                                 memcpy(cp-1, tmpbuffer, lastchar - cp);
     247                 :            :                         }
     248                 :          0 :                         *(--lastchar) = '\0';
     249                 :          0 :                         --cp;
     250                 :          0 :                         kdb_printf("\b%s \r", cp);
     251                 :          0 :                         tmp = *cp;
     252                 :          0 :                         *cp = '\0';
     253                 :          0 :                         kdb_printf(kdb_prompt_str);
     254                 :          0 :                         kdb_printf("%s", buffer);
     255                 :          0 :                         *cp = tmp;
     256                 :            :                 }
     257                 :            :                 break;
     258                 :            :         case 13: /* enter */
     259                 :          0 :                 *lastchar++ = '\n';
     260                 :          0 :                 *lastchar++ = '\0';
     261                 :          0 :                 if (!KDB_STATE(KGDB_TRANS)) {
     262                 :          0 :                         KDB_STATE_SET(KGDB_TRANS);
     263                 :          0 :                         kdb_printf("%s", buffer);
     264                 :            :                 }
     265                 :          0 :                 kdb_printf("\n");
     266                 :          0 :                 return buffer;
     267                 :            :         case 4: /* Del */
     268                 :          0 :                 if (cp < lastchar) {
     269                 :          0 :                         memcpy(tmpbuffer, cp+1, lastchar - cp - 1);
     270                 :          0 :                         memcpy(cp, tmpbuffer, lastchar - cp - 1);
     271                 :          0 :                         *(--lastchar) = '\0';
     272                 :          0 :                         kdb_printf("%s \r", cp);
     273                 :          0 :                         tmp = *cp;
     274                 :          0 :                         *cp = '\0';
     275                 :          0 :                         kdb_printf(kdb_prompt_str);
     276                 :          0 :                         kdb_printf("%s", buffer);
     277                 :          0 :                         *cp = tmp;
     278                 :            :                 }
     279                 :            :                 break;
     280                 :            :         case 1: /* Home */
     281                 :          0 :                 if (cp > buffer) {
     282                 :          0 :                         kdb_printf("\r");
     283                 :          0 :                         kdb_printf(kdb_prompt_str);
     284                 :            :                         cp = buffer;
     285                 :            :                 }
     286                 :            :                 break;
     287                 :            :         case 5: /* End */
     288                 :          0 :                 if (cp < lastchar) {
     289                 :          0 :                         kdb_printf("%s", cp);
     290                 :            :                         cp = lastchar;
     291                 :            :                 }
     292                 :            :                 break;
     293                 :            :         case 2: /* Left */
     294                 :          0 :                 if (cp > buffer) {
     295                 :          0 :                         kdb_printf("\b");
     296                 :          0 :                         --cp;
     297                 :            :                 }
     298                 :            :                 break;
     299                 :            :         case 14: /* Down */
     300                 :          0 :                 memset(tmpbuffer, ' ',
     301                 :          0 :                        strlen(kdb_prompt_str) + (lastchar-buffer));
     302                 :          0 :                 *(tmpbuffer+strlen(kdb_prompt_str) +
     303                 :          0 :                   (lastchar-buffer)) = '\0';
     304                 :          0 :                 kdb_printf("\r%s\r", tmpbuffer);
     305                 :          0 :                 *lastchar = (char)key;
     306                 :          0 :                 *(lastchar+1) = '\0';
     307                 :          0 :                 return lastchar;
     308                 :            :         case 6: /* Right */
     309                 :          0 :                 if (cp < lastchar) {
     310                 :          0 :                         kdb_printf("%c", *cp);
     311                 :          0 :                         ++cp;
     312                 :            :                 }
     313                 :            :                 break;
     314                 :            :         case 16: /* Up */
     315                 :          0 :                 memset(tmpbuffer, ' ',
     316                 :          0 :                        strlen(kdb_prompt_str) + (lastchar-buffer));
     317                 :          0 :                 *(tmpbuffer+strlen(kdb_prompt_str) +
     318                 :          0 :                   (lastchar-buffer)) = '\0';
     319                 :          0 :                 kdb_printf("\r%s\r", tmpbuffer);
     320                 :          0 :                 *lastchar = (char)key;
     321                 :          0 :                 *(lastchar+1) = '\0';
     322                 :          0 :                 return lastchar;
     323                 :            :         case 9: /* Tab */
     324                 :          0 :                 if (tab < 2)
     325                 :          0 :                         ++tab;
     326                 :            :                 p_tmp = buffer;
     327                 :          0 :                 while (*p_tmp == ' ')
     328                 :          0 :                         p_tmp++;
     329                 :          0 :                 if (p_tmp > cp)
     330                 :            :                         break;
     331                 :          0 :                 memcpy(tmpbuffer, p_tmp, cp-p_tmp);
     332                 :          0 :                 *(tmpbuffer + (cp-p_tmp)) = '\0';
     333                 :          0 :                 p_tmp = strrchr(tmpbuffer, ' ');
     334                 :          0 :                 if (p_tmp)
     335                 :          0 :                         ++p_tmp;
     336                 :            :                 else
     337                 :            :                         p_tmp = tmpbuffer;
     338                 :          0 :                 len = strlen(p_tmp);
     339                 :          0 :                 buf_size = sizeof(tmpbuffer) - (p_tmp - tmpbuffer);
     340                 :          0 :                 count = kallsyms_symbol_complete(p_tmp, buf_size);
     341                 :          0 :                 if (tab == 2 && count > 0) {
     342                 :          0 :                         kdb_printf("\n%d symbols are found.", count);
     343                 :          0 :                         if (count > dtab_count) {
     344                 :            :                                 count = dtab_count;
     345                 :          0 :                                 kdb_printf(" But only first %d symbols will"
     346                 :            :                                            " be printed.\nYou can change the"
     347                 :            :                                            " environment variable DTABCOUNT.",
     348                 :            :                                            count);
     349                 :            :                         }
     350                 :          0 :                         kdb_printf("\n");
     351                 :          0 :                         for (i = 0; i < count; i++) {
     352                 :          0 :                                 ret = kallsyms_symbol_next(p_tmp, i, buf_size);
     353                 :          0 :                                 if (WARN_ON(!ret))
     354                 :            :                                         break;
     355                 :          0 :                                 if (ret != -E2BIG)
     356                 :          0 :                                         kdb_printf("%s ", p_tmp);
     357                 :            :                                 else
     358                 :          0 :                                         kdb_printf("%s... ", p_tmp);
     359                 :          0 :                                 *(p_tmp + len) = '\0';
     360                 :            :                         }
     361                 :          0 :                         if (i >= dtab_count)
     362                 :          0 :                                 kdb_printf("...");
     363                 :          0 :                         kdb_printf("\n");
     364                 :          0 :                         kdb_printf(kdb_prompt_str);
     365                 :          0 :                         kdb_printf("%s", buffer);
     366                 :          0 :                 } else if (tab != 2 && count > 0) {
     367                 :          0 :                         len_tmp = strlen(p_tmp);
     368                 :          0 :                         strncpy(p_tmp+len_tmp, cp, lastchar-cp+1);
     369                 :          0 :                         len_tmp = strlen(p_tmp);
     370                 :          0 :                         strncpy(cp, p_tmp+len, len_tmp-len + 1);
     371                 :            :                         len = len_tmp - len;
     372                 :          0 :                         kdb_printf("%s", cp);
     373                 :          0 :                         cp += len;
     374                 :          0 :                         lastchar += len;
     375                 :            :                 }
     376                 :          0 :                 kdb_nextline = 1; /* reset output line number */
     377                 :          0 :                 break;
     378                 :            :         default:
     379                 :          0 :                 if (key >= 32 && lastchar < bufend) {
     380                 :          0 :                         if (cp < lastchar) {
     381                 :          0 :                                 memcpy(tmpbuffer, cp, lastchar - cp);
     382                 :          0 :                                 memcpy(cp+1, tmpbuffer, lastchar - cp);
     383                 :          0 :                                 *++lastchar = '\0';
     384                 :          0 :                                 *cp = key;
     385                 :          0 :                                 kdb_printf("%s\r", cp);
     386                 :            :                                 ++cp;
     387                 :          0 :                                 tmp = *cp;
     388                 :          0 :                                 *cp = '\0';
     389                 :          0 :                                 kdb_printf(kdb_prompt_str);
     390                 :          0 :                                 kdb_printf("%s", buffer);
     391                 :          0 :                                 *cp = tmp;
     392                 :            :                         } else {
     393                 :          0 :                                 *++lastchar = '\0';
     394                 :          0 :                                 *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                 :          0 :                                 if (!KDB_STATE(KGDB_TRANS)) {
     400                 :          0 :                                         if (kgdb_transition_check(buffer))
     401                 :            :                                                 return buffer;
     402                 :            :                                 } else {
     403                 :          0 :                                         kdb_printf("%c", key);
     404                 :            :                                 }
     405                 :            :                         }
     406                 :            :                         /* Special escape to kgdb */
     407                 :          0 :                         if (lastchar - buffer >= 5 &&
     408                 :          0 :                             strcmp(lastchar - 5, "$?#3f") == 0) {
     409                 :          0 :                                 kdb_gdb_state_pass(lastchar - 5);
     410                 :          0 :                                 strcpy(buffer, "kgdb");
     411                 :          0 :                                 KDB_STATE_SET(DOING_KGDB);
     412                 :          0 :                                 return buffer;
     413                 :            :                         }
     414                 :          0 :                         if (lastchar - buffer >= 11 &&
     415                 :          0 :                             strcmp(lastchar - 11, "$qSupported") == 0) {
     416                 :          0 :                                 kdb_gdb_state_pass(lastchar - 11);
     417                 :          0 :                                 strcpy(buffer, "kgdb");
     418                 :          0 :                                 KDB_STATE_SET(DOING_KGDB);
     419                 :          0 :                                 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                 :            : 
     446                 :          0 : char *kdb_getstr(char *buffer, size_t bufsize, const char *prompt)
     447                 :            : {
     448                 :          0 :         if (prompt && kdb_prompt_str != prompt)
     449                 :          0 :                 strscpy(kdb_prompt_str, prompt, CMD_BUFLEN);
     450                 :          0 :         kdb_printf(kdb_prompt_str);
     451                 :          0 :         kdb_nextline = 1;       /* Prompt and input resets line number */
     452                 :          0 :         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                 :            : 
     472                 :          0 : static void kdb_input_flush(void)
     473                 :            : {
     474                 :            :         get_char_func *f;
     475                 :            :         int res;
     476                 :            :         int flush_delay = 1;
     477                 :          0 :         while (flush_delay) {
     478                 :          0 :                 flush_delay--;
     479                 :            : empty:
     480                 :            :                 touch_nmi_watchdog();
     481                 :          0 :                 for (f = &kdb_poll_funcs[0]; *f; ++f) {
     482                 :          0 :                         res = (*f)();
     483                 :          0 :                         if (res != -1) {
     484                 :            :                                 flush_delay = 1;
     485                 :            :                                 goto empty;
     486                 :            :                         }
     487                 :            :                 }
     488                 :          0 :                 if (flush_delay)
     489                 :          0 :                         mdelay(1);
     490                 :            :         }
     491                 :          0 : }
     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                 :            : 
     514                 :            : static char kdb_buffer[256];    /* A bit too big to go on stack */
     515                 :            : static char *next_avail = kdb_buffer;
     516                 :            : static int  size_avail;
     517                 :            : static 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                 :            :  */
     525                 :          0 : static 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                 :          0 :         len1 = strlen(searched)-1;
     532                 :          0 :         len2 = strlen(searchfor);
     533                 :          0 :         if (len1 < len2)
     534                 :            :                 return 0;
     535                 :          0 :         if (kdb_grep_leading && kdb_grep_trailing && len1 != len2)
     536                 :            :                 return 0;
     537                 :          0 :         if (kdb_grep_leading) {
     538                 :          0 :                 if (!strncmp(searched, searchfor, len2))
     539                 :            :                         return 1;
     540                 :          0 :         } else if (kdb_grep_trailing) {
     541                 :          0 :                 if (!strncmp(searched+len1-len2, searchfor, len2))
     542                 :            :                         return 1;
     543                 :            :         } else {
     544                 :          0 :                 firstchar = *searchfor;
     545                 :            :                 cp = searched;
     546                 :          0 :                 while ((cp = strchr(cp, firstchar))) {
     547                 :          0 :                         if (!strncmp(cp, searchfor, len2))
     548                 :            :                                 return 1;
     549                 :          0 :                         cp++;
     550                 :            :                 }
     551                 :            :         }
     552                 :          0 :         return 0;
     553                 :            : }
     554                 :            : 
     555                 :          0 : int 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                 :          0 :         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                 :          0 :         local_irq_save(flags);
     574                 :          0 :         this_cpu = smp_processor_id();
     575                 :            :         for (;;) {
     576                 :          0 :                 old_cpu = cmpxchg(&kdb_printf_cpu, -1, this_cpu);
     577                 :          0 :                 if (old_cpu == -1 || old_cpu == this_cpu)
     578                 :            :                         break;
     579                 :            : 
     580                 :          0 :                 cpu_relax();
     581                 :          0 :         }
     582                 :            : 
     583                 :          0 :         diag = kdbgetintenv("LINES", &linecount);
     584                 :          0 :         if (diag || linecount <= 1)
     585                 :          0 :                 linecount = 24;
     586                 :            : 
     587                 :          0 :         diag = kdbgetintenv("COLUMNS", &colcount);
     588                 :          0 :         if (diag || colcount <= 1)
     589                 :          0 :                 colcount = 80;
     590                 :            : 
     591                 :          0 :         diag = kdbgetintenv("LOGGING", &logging);
     592                 :          0 :         if (diag)
     593                 :          0 :                 logging = 0;
     594                 :            : 
     595                 :          0 :         if (!kdb_grepping_flag || suspend_grep) {
     596                 :            :                 /* normally, every vsnprintf starts a new buffer */
     597                 :          0 :                 next_avail = kdb_buffer;
     598                 :          0 :                 size_avail = sizeof(kdb_buffer);
     599                 :            :         }
     600                 :          0 :         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                 :          0 :         if (!suspend_grep && kdb_grepping_flag) {
     612                 :          0 :                 cp = strchr(kdb_buffer, '\n');
     613                 :          0 :                 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                 :          0 :                         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                 :          0 :                                 len = strlen(kdb_prompt_str);
     635                 :          0 :                                 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                 :          0 :                                         kdb_grepping_flag = 0;
     642                 :          0 :                                         goto kdb_printit;
     643                 :            :                                 }
     644                 :            :                         }
     645                 :            :                         /* no newline; don't search/write the buffer
     646                 :            :                            until one is there */
     647                 :          0 :                         len = strlen(kdb_buffer);
     648                 :          0 :                         next_avail = kdb_buffer + len;
     649                 :          0 :                         size_avail = sizeof(kdb_buffer) - len;
     650                 :          0 :                         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                 :          0 :                 cp++;                /* to byte after the newline */
     658                 :          0 :                 replaced_byte = *cp; /* remember what/where it was */
     659                 :            :                 cphold = cp;
     660                 :          0 :                 *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                 :          0 :                 fnd = kdb_search_string(kdb_buffer, kdb_grep_string);
     668                 :          0 :                 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                 :          0 :                         *cphold = replaced_byte;
     676                 :          0 :                         strcpy(kdb_buffer, cphold);
     677                 :          0 :                         len = strlen(kdb_buffer);
     678                 :          0 :                         next_avail = kdb_buffer + len;
     679                 :          0 :                         size_avail = sizeof(kdb_buffer) - len;
     680                 :          0 :                         goto kdb_print_out;
     681                 :            :                 }
     682                 :          0 :                 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                 :          0 :                         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                 :            :         }
     693                 :            : kdb_printit:
     694                 :            : 
     695                 :            :         /*
     696                 :            :          * Write to all consoles.
     697                 :            :          */
     698                 :          0 :         retlen = strlen(kdb_buffer);
     699                 :          0 :         cp = (char *) printk_skip_headers(kdb_buffer);
     700                 :          0 :         if (!dbg_kdb_mode && kgdb_connected) {
     701                 :          0 :                 gdbstub_msg_write(cp, retlen - (cp - kdb_buffer));
     702                 :            :         } else {
     703                 :          0 :                 if (dbg_io_ops && !dbg_io_ops->is_console) {
     704                 :          0 :                         len = retlen - (cp - kdb_buffer);
     705                 :            :                         cp2 = cp;
     706                 :          0 :                         while (len--) {
     707                 :          0 :                                 dbg_io_ops->write_char(*cp2);
     708                 :          0 :                                 cp2++;
     709                 :            :                         }
     710                 :            :                 }
     711                 :          0 :                 while (c) {
     712                 :          0 :                         c->write(c, cp, retlen - (cp - kdb_buffer));
     713                 :            :                         touch_nmi_watchdog();
     714                 :          0 :                         c = c->next;
     715                 :            :                 }
     716                 :            :         }
     717                 :          0 :         if (logging) {
     718                 :          0 :                 saved_loglevel = console_loglevel;
     719                 :          0 :                 console_loglevel = CONSOLE_LOGLEVEL_SILENT;
     720                 :          0 :                 if (printk_get_level(kdb_buffer) || src == KDB_MSGSRC_PRINTK)
     721                 :          0 :                         printk("%s", kdb_buffer);
     722                 :            :                 else
     723                 :          0 :                         pr_info("%s", kdb_buffer);
     724                 :            :         }
     725                 :            : 
     726                 :          0 :         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                 :          0 :                 while (len--) {
     735                 :          0 :                         if (kdb_buffer[len] == '\n') {
     736                 :          0 :                                 kdb_nextline++;
     737                 :            :                                 got = 0;
     738                 :          0 :                         } else if (kdb_buffer[len] == '\r') {
     739                 :            :                                 got = 0;
     740                 :            :                         } else {
     741                 :          0 :                                 got++;
     742                 :            :                         }
     743                 :            :                 }
     744                 :          0 :                 kdb_nextline += got / (colcount + 1);
     745                 :            :         }
     746                 :            : 
     747                 :            :         /* check for having reached the LINES number of printed lines */
     748                 :          0 :         if (kdb_nextline >= linecount) {
     749                 :          0 :                 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                 :          0 :                 kdb_nextline = 1;       /* In case of recursion */
     756                 :            : 
     757                 :            :                 /*
     758                 :            :                  * Pause until cr.
     759                 :            :                  */
     760                 :          0 :                 moreprompt = kdbgetenv("MOREPROMPT");
     761                 :          0 :                 if (moreprompt == NULL)
     762                 :            :                         moreprompt = "more> ";
     763                 :            : 
     764                 :          0 :                 kdb_input_flush();
     765                 :          0 :                 c = console_drivers;
     766                 :            : 
     767                 :          0 :                 if (dbg_io_ops && !dbg_io_ops->is_console) {
     768                 :          0 :                         len = strlen(moreprompt);
     769                 :            :                         cp = moreprompt;
     770                 :          0 :                         while (len--) {
     771                 :          0 :                                 dbg_io_ops->write_char(*cp);
     772                 :          0 :                                 cp++;
     773                 :            :                         }
     774                 :            :                 }
     775                 :          0 :                 while (c) {
     776                 :          0 :                         c->write(c, moreprompt, strlen(moreprompt));
     777                 :            :                         touch_nmi_watchdog();
     778                 :          0 :                         c = c->next;
     779                 :            :                 }
     780                 :            : 
     781                 :          0 :                 if (logging)
     782                 :          0 :                         printk("%s", moreprompt);
     783                 :            : 
     784                 :          0 :                 kdb_read(buf1, 2); /* '2' indicates to return
     785                 :            :                                     * immediately after getting one key. */
     786                 :          0 :                 kdb_nextline = 1;       /* Really set output line 1 */
     787                 :            : 
     788                 :            :                 /* empty and reset the buffer: */
     789                 :          0 :                 kdb_buffer[0] = '\0';
     790                 :          0 :                 next_avail = kdb_buffer;
     791                 :          0 :                 size_avail = sizeof(kdb_buffer);
     792                 :          0 :                 if ((buf1[0] == 'q') || (buf1[0] == 'Q')) {
     793                 :            :                         /* user hit q or Q */
     794                 :          0 :                         KDB_FLAG_SET(CMD_INTERRUPT); /* command interrupted */
     795                 :          0 :                         KDB_STATE_CLEAR(PAGER);
     796                 :            :                         /* end of command output; back to normal mode */
     797                 :          0 :                         kdb_grepping_flag = 0;
     798                 :          0 :                         kdb_printf("\n");
     799                 :          0 :                 } else if (buf1[0] == ' ') {
     800                 :          0 :                         kdb_printf("\r");
     801                 :          0 :                         suspend_grep = 1; /* for this recursion */
     802                 :          0 :                 } else if (buf1[0] == '\n') {
     803                 :          0 :                         kdb_nextline = linecount - 1;
     804                 :          0 :                         kdb_printf("\r");
     805                 :          0 :                         suspend_grep = 1; /* for this recursion */
     806                 :          0 :                 } else if (buf1[0] == '/' && !kdb_grepping_flag) {
     807                 :          0 :                         kdb_printf("\r");
     808                 :          0 :                         kdb_getstr(kdb_grep_string, KDB_GREP_STRLEN,
     809                 :          0 :                                    kdbgetenv("SEARCHPROMPT") ?: "search> ");
     810                 :          0 :                         *strchrnul(kdb_grep_string, '\n') = '\0';
     811                 :          0 :                         kdb_grepping_flag += KDB_GREPPING_FLAG_SEARCH;
     812                 :          0 :                         suspend_grep = 1; /* for this recursion */
     813                 :          0 :                 } else if (buf1[0] && buf1[0] != '\n') {
     814                 :            :                         /* user hit something other than enter */
     815                 :          0 :                         suspend_grep = 1; /* for this recursion */
     816                 :          0 :                         if (buf1[0] != '/')
     817                 :          0 :                                 kdb_printf(
     818                 :            :                                     "\nOnly 'q', 'Q' or '/' are processed at "
     819                 :            :                                     "more prompt, input ignored\n");
     820                 :            :                         else
     821                 :          0 :                                 kdb_printf("\n'/' cannot be used during | "
     822                 :            :                                            "grep filtering, input ignored\n");
     823                 :          0 :                 } else if (kdb_grepping_flag) {
     824                 :            :                         /* user hit enter */
     825                 :          0 :                         suspend_grep = 1; /* for this recursion */
     826                 :          0 :                         kdb_printf("\n");
     827                 :            :                 }
     828                 :          0 :                 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                 :          0 :         if (kdb_grepping_flag && !suspend_grep) {
     838                 :          0 :                 *cphold = replaced_byte;
     839                 :          0 :                 strcpy(kdb_buffer, cphold);
     840                 :          0 :                 len = strlen(kdb_buffer);
     841                 :          0 :                 next_avail = kdb_buffer + len;
     842                 :          0 :                 size_avail = sizeof(kdb_buffer) - len;
     843                 :            :         }
     844                 :            : 
     845                 :            : kdb_print_out:
     846                 :          0 :         suspend_grep = 0; /* end of what may have been a recursive call */
     847                 :          0 :         if (logging)
     848                 :          0 :                 console_loglevel = saved_loglevel;
     849                 :            :         /* kdb_printf_cpu locked the code above. */
     850                 :          0 :         smp_store_release(&kdb_printf_cpu, old_cpu);
     851                 :          0 :         local_irq_restore(flags);
     852                 :          0 :         return retlen;
     853                 :            : }
     854                 :            : 
     855                 :          0 : int kdb_printf(const char *fmt, ...)
     856                 :            : {
     857                 :            :         va_list ap;
     858                 :            :         int r;
     859                 :            : 
     860                 :          0 :         va_start(ap, fmt);
     861                 :          0 :         r = vkdb_printf(KDB_MSGSRC_INTERNAL, fmt, ap);
     862                 :          0 :         va_end(ap);
     863                 :            : 
     864                 :          0 :         return r;
     865                 :            : }
     866                 :            : EXPORT_SYMBOL_GPL(kdb_printf);
    

Generated by: LCOV version 1.14