Logo Search packages:      
Sourcecode: linux version File versions  Download package

udbg_beat.c

/*
 * udbg function for Beat
 *
 * (C) Copyright 2006 TOSHIBA CORPORATION
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License along
 * with this program; if not, write to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
 */

#include <linux/kernel.h>
#include <linux/console.h>

#include <asm/machdep.h>
#include <asm/prom.h>
#include <asm/udbg.h>

#include "beat.h"

#define     celleb_vtermno    0

static void udbg_putc_beat(char c)
{
      unsigned long rc;

      if (c == '\n')
            udbg_putc_beat('\r');

      rc = beat_put_term_char(celleb_vtermno, 1, (uint64_t)c << 56, 0);
}

/* Buffered chars getc */
static long inbuflen;
static long inbuf[2];   /* must be 2 longs */

static int udbg_getc_poll_beat(void)
{
      /* The interface is tricky because it may return up to 16 chars.
       * We save them statically for future calls to udbg_getc().
       */
      char ch, *buf = (char *)inbuf;
      int i;
      long rc;
      if (inbuflen == 0) {
            /* get some more chars. */
            inbuflen = 0;
            rc = beat_get_term_char(celleb_vtermno, &inbuflen, inbuf+0, inbuf+1);
            if (rc != 0)
                  inbuflen = 0;     /* otherwise inbuflen is garbage */
      }
      if (inbuflen <= 0 || inbuflen > 16) {
            /* Catch error case as well as other oddities (corruption) */
            inbuflen = 0;
            return -1;
      }
      ch = buf[0];
      for (i = 1; i < inbuflen; i++)      /* shuffle them down. */
            buf[i-1] = buf[i];
      inbuflen--;
      return ch;
}

static int udbg_getc_beat(void)
{
      int ch;
      for (;;) {
            ch = udbg_getc_poll_beat();
            if (ch == -1) {
                  /* This shouldn't be needed...but... */
                  volatile unsigned long delay;
                  for (delay=0; delay < 2000000; delay++)
                        ;
            } else {
                  return ch;
            }
      }
}

/* call this from early_init() for a working debug console on
 * vterm capable LPAR machines
 */
void __init udbg_init_debug_beat(void)
{
      udbg_putc = udbg_putc_beat;
      udbg_getc = udbg_getc_beat;
      udbg_getc_poll = udbg_getc_poll_beat;
}

Generated by  Doxygen 1.6.0   Back to index