source: rtems/c/src/lib/libbsp/arm/nds/console/console.c @ c499856

/*
 * RTEMS for Nintendo DS console driver.
 *
 * Copyright (c) 2008 by Renaud Voltz <renaud.voltz@gmail.com>
 *                       Matthieu Bucchianeri <mbucchia@gmail.com>
 *
 * The license and distribution terms for this file may be
 * found in the file LICENSE in this distribution or at
 *
 * http://www.rtems.org/license/LICENSE
 */

#include <bsp.h>
#include <nds.h>
#include <rtems/libio.h>
#include <nds/arm9/console.h>
#include <sys/iosupport.h>

#include <rtems/mw_uid.h>

/*
 * enables testsuite output to desmume. this is used to pass the rtems
 * testsuite.
 * comment the following line to disable (recommended).
 */

//#define TESTSUITE

/*
 * printk support.
 */

/* from NDS support library */
extern void consolePrintChar(char c);
void
nds_putch (char c)
{
#ifdef TESTSUITE
  __asm__ volatile ("swi $0x1");
#endif
  consolePrintChar (c);
}

static volatile char ch = 0;

void
console_push (char c)
{
  ch = c;
}

int
nds_getch (void)
{
  char c;

  while (ch == 0);
  c = ch;
  ch = 0;
  return c;
}

BSP_output_char_function_type BSP_output_char = nds_putch;
BSP_polling_getchar_function_type BSP_poll_char = nds_getch;

/*
 * console write operation.
 */

static ssize_t
nds_write (int minor, const char *buf, size_t len)
{
  int count;

  for (count = 0; count < len; count++) {
    nds_putch (buf[count]);
  }

  return 0;
}

/*
 * console read operation.
 */

static int
nds_read (int minor)
{
  return nds_getch ();
}

/*
 * from touchscreen/parser.c
 */

void register_kbd_msg_queue (char *q_name);
void unregister_kbd_msg_queue (void);

/*
 * Console driver
 */

rtems_device_driver
console_initialize (rtems_device_major_number major,
                    rtems_device_minor_number minor, void *arg)
{
  rtems_status_code status;

  printk ("[+] console started\n");

  rtems_termios_initialize ();

  status = rtems_io_register_name ("/dev/console", major, 0);
  if (status != RTEMS_SUCCESSFUL) {
    printk ("[!] error registering console\n");
    rtems_fatal_error_occurred (status);
  }

  return (RTEMS_SUCCESSFUL);
}

rtems_device_driver
console_open (rtems_device_major_number major,
              rtems_device_minor_number minor, void *arg)
{
  rtems_status_code status;
  static rtems_termios_callbacks cb = {
    NULL,                       /* firstOpen     */
    NULL,                       /* lastClose     */
    nds_read,                   /* pollRead      */
    nds_write,                  /* write         */
    NULL,                       /* setAttributes */
    NULL,                       /* stopRemoteTx  */
    NULL,                       /* startRemoteTx */
    0                           /* 1 = outputUsesInterrupts */
  };

  status = rtems_termios_open (major, minor, arg, &cb);
  if (status != RTEMS_SUCCESSFUL)
    printk ("[!] error opening console\n");

  return (status);
}

rtems_device_driver
console_close (rtems_device_major_number major,
               rtems_device_minor_number minor, void *arg)
{
  rtems_device_driver res = RTEMS_SUCCESSFUL;

  res = rtems_termios_close (arg);

  return res;
}

rtems_device_driver
console_read (rtems_device_major_number major,
              rtems_device_minor_number minor, void *arg)
{
  return rtems_termios_read (arg);
}

rtems_device_driver
console_write (rtems_device_major_number major,
               rtems_device_minor_number minor, void *arg)
{
  return rtems_termios_write (arg);
}

rtems_device_driver
console_control (rtems_device_major_number major,
                 rtems_device_minor_number minor, void *arg)
{
  rtems_libio_ioctl_args_t *args = arg;

  switch (args->command) {
  case MW_UID_REGISTER_DEVICE:
    register_kbd_msg_queue (args->buffer);
    break;
  case MW_UID_UNREGISTER_DEVICE:
    unregister_kbd_msg_queue ();
    break;
  default:
    return rtems_termios_ioctl (arg);
  }
  args->ioctl_return = 0;

  return RTEMS_SUCCESSFUL;
}