kernel/arch/mips32/src/drivers/msim.c

   1 /*
   2  * Copyright (C) 2005 Ondrej Palkovsky
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  *
   9  * - Redistributions of source code must retain the above copyright
  10  *   notice, this list of conditions and the following disclaimer.
  11  * - Redistributions in binary form must reproduce the above copyright
  12  *   notice, this list of conditions and the following disclaimer in the
  13  *   documentation and/or other materials provided with the distribution.
  14  * - The name of the author may not be used to endorse or promote products
  15  *   derived from this software without specific prior written permission.
  16  *
  17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  18  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  19  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  20  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  21  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  22  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  23  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  24  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  25  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  26  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  27  */
  28
  29 /** @addtogroup mips32
  30  * @{
  31  */
  32 /** @file
  33  */
  34
  35 #include <interrupt.h>
  36 #include <console/chardev.h>
  37 #include <arch/drivers/msim.h>
  38 #include <arch/cp0.h>
  39 #include <console/console.h>
  40 #include <ddi/irq.h>
  41 #include <sysinfo/sysinfo.h>
  42
  43 /** Address of devices. */
  44 #define MSIM_VIDEORAM           0xB0000000
  45 #define MSIM_KBD_ADDRESS        0xB0000000
  46 #define MSIM_KBD_IRQ            2
  47
  48 static chardev_t console;
  49 static irq_t msim_irq;
  50
  51 static void msim_write(chardev_t *dev, const char ch);
  52 static void msim_enable(chardev_t *dev);
  53 static void msim_disable(chardev_t *dev);
  54 static char msim_do_read(chardev_t *dev);
  55
  56 static chardev_operations_t msim_ops = {
  57         .resume = msim_enable,
  58         .suspend = msim_disable,
  59         .write = msim_write,
  60         .read = msim_do_read,
  61 };
  62
  63 /** Putchar that works with MSIM & gxemul */
  64 void msim_write(chardev_t *dev, const char ch)
  65 {
  66         *((char *) MSIM_VIDEORAM) = ch;
  67 }
  68
  69 /* Called from getc(). */
  70 void msim_enable(chardev_t *dev)
  71 {
  72         cp0_unmask_int(MSIM_KBD_IRQ);
  73 }
  74
  75 /* Called from getc(). */
  76 void msim_disable(chardev_t *dev)
  77 {
  78         cp0_mask_int(MSIM_KBD_IRQ);
  79 }
  80
  81 #include <print.h>
  82 /** Read character using polling, assume interrupts disabled */
  83 static char msim_do_read(chardev_t *dev)
  84 {
  85         char ch;
  86
  87         while (1) {
  88                 ch = *((volatile char *) MSIM_KBD_ADDRESS);
  89                 if (ch) {
  90                         if (ch == '\r')
  91                                 return '\n';
  92                         if (ch == 0x7f)
  93                                 return '\b';
  94                         return ch;
  95                 }
  96         }
  97 }
  98
  99 /** Process keyboard interrupt. */
 100 static void msim_irq_handler(irq_t *irq, void *arg, ...)
 101 {
 102         if ((irq->notif_cfg.notify) && (irq->notif_cfg.answerbox))
 103                 ipc_irq_send_notif(irq);
 104         else {
 105                 char ch = 0;
 106
 107                         ch = *((char *) MSIM_KBD_ADDRESS);
 108                         if (ch =='\r')
 109                                 ch = '\n';
 110                         if (ch == 0x7f)
 111                                 ch = '\b';
 112                         chardev_push_character(&console, ch);
 113         }
 114 }
 115
 116 static irq_ownership_t msim_claim(void)
 117 {
 118         return IRQ_ACCEPT;
 119 }
 120
 121 void msim_kbd_grab(void)
 122 {
 123         ipl_t ipl = interrupts_disable();
 124         spinlock_lock(&msim_irq.lock);
 125         msim_irq.notif_cfg.notify = false;
 126         spinlock_unlock(&msim_irq.lock);
 127         interrupts_restore(ipl);
 128 }
 129
 130 void msim_kbd_release(void)
 131 {
 132         ipl_t ipl = interrupts_disable();
 133         spinlock_lock(&msim_irq.lock);
 134         if (msim_irq.notif_cfg.answerbox)
 135                 msim_irq.notif_cfg.notify = true;
 136         spinlock_unlock(&msim_irq.lock);
 137         interrupts_restore(ipl);
 138 }
 139
 140
 141 /* Return console object representing msim console */
 142 void msim_console(devno_t devno)
 143 {
 144         chardev_initialize("msim_console", &console, &msim_ops);
 145         stdin = &console;
 146         stdout = &console;
 147
 148         irq_initialize(&msim_irq);
 149         msim_irq.devno = devno;
 150         msim_irq.inr = MSIM_KBD_IRQ;
 151         msim_irq.claim = msim_claim;
 152         msim_irq.handler = msim_irq_handler;
 153         irq_register(&msim_irq);
 154
 155         cp0_unmask_int(MSIM_KBD_IRQ);
 156
 157         sysinfo_set_item_val("kbd", NULL, true);
 158         sysinfo_set_item_val("kbd.devno", NULL, devno);
 159         sysinfo_set_item_val("kbd.inr", NULL, MSIM_KBD_IRQ);
 160         sysinfo_set_item_val("kbd.address.virtual", NULL, MSIM_KBD_ADDRESS);
 161 }
 162
 163 /** @}
 164  */