URL https://opencores.org/ocsvn/or1k/or1k/trunk

Subversion Repositories or1k

[/] [or1k/] [tags/] [rel-0-3-0-rc3/] [or1ksim/] [peripheral/] [ps2kbd.c] - Blame information for rev 1765

Details | Compare with Previous | View Log


/* ps2kbd.c -- Very simple (and limited) PS/2 keyboard simulation
 
   Copyright (C) 2002 Marko Mlinar, markom@opencores.org
   Copyright (C) 2008 Embecosm Limited
 
   Contributor Jeremy Bennett <jeremy.bennett@embecosm.com>
 
   This file is part of Or1ksim, the OpenRISC 1000 Architectural Simulator.
 
   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 3 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, see <http://www.gnu.org/licenses/>.  */
 
/* This program is commented throughout in a fashion suitable for processing
   with Doxygen. */
 
 
/* Autoconf and/or portability configuration */
#include "config.h"
#include "port.h"
 
/* System includes */
#include <stdlib.h>
#include <stdio.h>
 
/* Package includes */
#include "arch.h"
#include "pic.h"
#include "sim-config.h"
#include "abstract.h"
#include "sched.h"
#include "toplevel-support.h"
#include "sim-cmd.h"
 
 
/* Device registers */
#define KBD_CTRL              4
#define KBD_DATA              0
#define KBD_SPACE             8
 
/* Keyboard commands */
#define KBD_KCMD_RST       0xFF
#define KBD_KCMD_DK        0xF5
#define KBD_KCMD_EK        0xF4
#define KBD_KCMD_ECHO      0xFF
#define KBD_KCMD_SRL       0xED
 
/* Keyboard responses */
#define KBD_KRESP_RSTOK    0xAA
#define KBD_KRESP_ECHO     0xEE
#define KBD_KRESP_ACK      0xFA
 
/* Controller commands */
#define KBD_CCMD_RCB       0x20
#define KBD_CCMD_WCB       0x60
#define KBD_CCMD_ST1       0xAA
#define KBD_CCMD_ST2       0xAB
#define KBD_CCMD_DKI       0xAD
#define KBD_CCMD_EKI       0xAE
 
/* Status register bits */
#define KBD_STATUS_OBF     0x01
#define KBD_STATUS_IBF     0x02
#define KBD_STATUS_SYS     0x04
#define KBD_STATUS_A2      0x08
#define KBD_STATUS_INH     0x10
#define KBD_STATUS_MOBF    0x20
#define KBD_STATUS_TO      0x40
#define KBD_STATUS_PERR    0x80
 
/* Command byte register bits */
#define KBD_CCMDBYTE_INT   0x01
#define KBD_CCMDBYTE_INT2  0x02
#define KBD_CCMDBYTE_SYS   0x04
#define KBD_CCMDBYTE_EN    0x10
#define KBD_CCMDBYTE_EN2   0x20
#define KBD_CCMDBYTE_XLAT  0x40
 
/* Length of internal scan code fifo */
#define KBD_MAX_BUF       0x100
 
/* Keyboard is checked every KBD_SLOWDOWN cycle */
#define KBD_BAUD_RATE      1200
 
/* ASCII to scan code conversion table */
const static struct
{
  /* Whether shift must be pressed */
  unsigned char shift;
  /* Scan code to be generated */
  unsigned char code;
} scan_table[128] =
{
/* 0 - 15 */
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x0E},
  {
  0, 0x0F},
  {
  0, 0x1C},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
/* 16 - 31 */
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x01},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
  {
  0, 0x00},
/* 32 - 47 */
  {
  0, 0x39},
  {
  1, 0x02},
  {
  1, 0x28},
  {
  1, 0x04},
  {
  1, 0x05},
  {
  1, 0x06},
  {
  1, 0x08},
  {
  0, 0x28},
  {
  1, 0x0A},
  {
  1, 0x0B},
  {
  1, 0x09},
  {
  1, 0x0D},
  {
  0, 0x33},
  {
  0, 0x0C},
  {
  0, 0x34},
  {
  0, 0x35},
/* 48 - 63 */
  {
  0, 0x0B},
  {
  0, 0x02},
  {
  0, 0x03},
  {
  0, 0x04},
  {
  0, 0x05},
  {
  0, 0x06},
  {
  0, 0x07},
  {
  0, 0x08},
  {
  0, 0x09},
  {
  0, 0x0A},
  {
  1, 0x27},
  {
  0, 0x27},
  {
  1, 0x33},
  {
  0, 0x0D},
  {
  1, 0x34},
  {
  1, 0x35},
/* 64 - 79 */
  {
  1, 0x03},
  {
  1, 0x1E},
  {
  1, 0x30},
  {
  1, 0x2E},
  {
  1, 0x20},
  {
  1, 0x12},
  {
  1, 0x21},
  {
  1, 0x22},
  {
  1, 0x23},
  {
  1, 0x17},
  {
  1, 0x24},
  {
  1, 0x25},
  {
  1, 0x26},
  {
  1, 0x32},
  {
  1, 0x31},
  {
  1, 0x18},
/* 80 - 95 */
  {
  1, 0x19},
  {
  1, 0x10},
  {
  1, 0x13},
  {
  1, 0x1F},
  {
  1, 0x14},
  {
  1, 0x16},
  {
  1, 0x2F},
  {
  1, 0x11},
  {
  1, 0x2D},
  {
  1, 0x15},
  {
  1, 0x2C},
  {
  0, 0x1A},
  {
  0, 0x2B},
  {
  0, 0x1B},
  {
  1, 0x07},
  {
  1, 0x0C},
/* 96 - 111 */
  {
  0, 0x29},
  {
  0, 0x1E},
  {
  0, 0x30},
  {
  0, 0x2E},
  {
  0, 0x20},
  {
  0, 0x12},
  {
  0, 0x21},
  {
  0, 0x22},
  {
  0, 0x23},
  {
  0, 0x17},
  {
  0, 0x24},
  {
  0, 0x25},
  {
  0, 0x26},
  {
  0, 0x32},
  {
  0, 0x31},
  {
  0, 0x18},
/* 112 - 127 */
  {
  0, 0x19},
  {
  0, 0x10},
  {
  0, 0x13},
  {
  0, 0x1F},
  {
  0, 0x14},
  {
  0, 0x16},
  {
  0, 0x2F},
  {
  0, 0x11},
  {
  0, 0x2D},
  {
  0, 0x15},
  {
  0, 0x2C},
  {
  1, 0x1A},
  {
  1, 0x2B},
  {
  1, 0x1B},
  {
  1, 0x29},
  {
  0, 0x00}
};
 
struct kbd_state
{
  /* Temporary buffer to store incoming scan codes */
  uint8_t buf[KBD_MAX_BUF];
 
  /* Number of scan codes in buffer */
  unsigned long buf_count;
  unsigned long buf_head;
  unsigned long buf_tail;
 
  /* Input stream */
  FILE *rxfs;
 
  /* Controller Command (write into 0x64) */
  int ccmd;
 
  /* Keyboard Command (write into 0x60) */
  uint8_t kcmd;
 
  /* Controller Command Byte */
  uint8_t ccmdbyte;
 
  /* Keyboard response pending */
  unsigned long kresp;
 
  /* Keyboard slowdown factor */
  long slowdown;
 
  /* Cofiguration */
  int enabled;
  int irq;
  oraddr_t baseaddr;
  char *rxfile;
};
 
static void
kbd_put (struct kbd_state *kbd, unsigned char c)
{
  if (kbd->buf_count >= KBD_MAX_BUF)
    {
      fprintf (stderr, "WARNING: Keyboard buffer overflow.\n");
    }
  else
    {
      kbd->buf[kbd->buf_head] = c;
      kbd->buf_head = (kbd->buf_head + 1) % KBD_MAX_BUF;
      kbd->buf_count++;
    }
}
 
/* Decodes ascii code c into multiple scan codes, placed into buf, length is returned */
static void
scan_decode (struct kbd_state *kbd, unsigned char c)
{
  /* Do not handle special characters and extended ascii */
  if (c >= 128 || !scan_table[c].code)
    return;
 
  /* Make shift? */
  if (scan_table[c].shift)
    kbd_put (kbd, 0x2a);
  /* Make char */
  kbd_put (kbd, scan_table[c].code);
  /* Break char */
  kbd_put (kbd, scan_table[c].code | 0x80);
  /* Break shift? */
  if (scan_table[c].shift)
    kbd_put (kbd, 0xaa);
}
 
/* Write a register */
static void
kbd_write8 (oraddr_t addr, uint8_t value, void *dat)
{
  struct kbd_state *kbd = dat;
  switch (addr)
    {
    case KBD_CTRL:
      kbd->ccmd = value & 0xff;
      if (kbd->ccmd == KBD_CCMD_RCB)
        kbd->kresp = 0x1;
      if (kbd->ccmd == KBD_CCMD_ST1)
        kbd->kresp = 0x1;
      if (kbd->ccmd == KBD_CCMD_ST2)
        kbd->kresp = 0x1;
      if (kbd->ccmd == KBD_CCMD_DKI)
        {
          clear_interrupt (kbd->irq);
          kbd->ccmdbyte |= KBD_CCMDBYTE_EN;
        }
      if (kbd->ccmd == KBD_CCMD_EKI)
        kbd->ccmdbyte &= ~KBD_CCMDBYTE_EN;
      if (config.sim.verbose)
        PRINTF ("kbd_write8(%" PRIxADDR ") %02x\n", addr, value);
      break;
    case KBD_DATA:
      if (kbd->ccmd == KBD_CCMD_WCB)
        {
          kbd->ccmdbyte = value & 0xff;
          kbd->ccmd = 0x00;
        }
      else
        kbd->kcmd = value & 0xff;
      if (kbd->kcmd == KBD_KCMD_DK)
        kbd->ccmdbyte |= KBD_CCMDBYTE_EN;
      if (kbd->kcmd == KBD_KCMD_EK)
        kbd->ccmdbyte &= ~KBD_CCMDBYTE_EN;
      kbd->kresp = 0x1;
      kbd->ccmd = 0x00;
      if (config.sim.verbose)
        PRINTF ("kbd_write8(%" PRIxADDR ") %02x\n", addr, value);
      break;
    default:
      fprintf (stderr, "Write out of keyboard space (0x%" PRIxADDR ")!\n",
               addr);
      break;
    }
}
 
/* Read a register */
static uint8_t
kbd_read8 (oraddr_t addr, void *dat)
{
  struct kbd_state *kbd = dat;
  switch (addr)
    {
    case KBD_CTRL:
      {
        unsigned long c = 0x0;
        if (kbd->kresp || kbd->buf_count)
          c |= KBD_STATUS_OBF;
        c |= kbd->ccmdbyte & KBD_CCMDBYTE_SYS;
        c |= KBD_STATUS_INH;
        if (config.sim.verbose)
          PRINTF ("kbd_read8(%" PRIxADDR ") %lx\n", addr, c);
        return c;
      }
    case KBD_DATA:
      clear_interrupt (kbd->irq);
      if (kbd->ccmd)
        {
          unsigned long rc = 0;
          if (kbd->ccmd == KBD_CCMD_RCB)
            rc = kbd->ccmdbyte;
          if (kbd->ccmd == KBD_CCMD_ST1)
            rc = 0x55;
          if (kbd->ccmd == KBD_CCMD_ST2)
            rc = 0x00;
          kbd->ccmd = 0x00;
          kbd->kresp = 0x0;
          if (config.sim.verbose)
            PRINTF ("kbd_read8(%" PRIxADDR ") %lx\n", addr, rc);
          return rc;
        }
      else if (kbd->kresp)
        {
          unsigned long rc;
          if (kbd->kresp == 0x2)
            {
              kbd->kresp = 0x0;
              rc = KBD_KRESP_RSTOK;
            }
          else if (kbd->kcmd == KBD_KCMD_RST)
            {
              kbd->kresp = 0x2;
              rc = KBD_KRESP_ACK;
            }
          else if (kbd->kcmd == KBD_KCMD_ECHO)
            {
              kbd->kresp = 0x0;
              rc = KBD_KRESP_ECHO;
            }
          else
            {
              kbd->kresp = 0x0;
              rc = KBD_KRESP_ACK;
            }
          kbd->kcmd = 0x00;
          if (config.sim.verbose)
            PRINTF ("kbd_read8(%" PRIxADDR ") %lx\n", addr, rc);
          return rc;
        }
      else if (kbd->buf_count)
        {
          unsigned long c = kbd->buf[kbd->buf_tail];
          kbd->buf_tail = (kbd->buf_tail + 1) % KBD_MAX_BUF;
          kbd->buf_count--;
          kbd->kresp = 0x0;
          if (config.sim.verbose)
            PRINTF ("kbd_read8(%" PRIxADDR ") %lx\n", addr, c);
          return c;
        }
      kbd->kresp = 0x0;
      if (config.sim.verbose)
        PRINTF ("kbd_read8(%" PRIxADDR ") fifo empty\n", addr);
      return 0;
    default:
      fprintf (stderr, "Read out of keyboard space (0x%" PRIxADDR ")!\n",
               addr);
      return 0;
    }
}
 
 
/* Simulation hook. Must be called every couple of clock cycles to simulate incomming data. */
static void
kbd_job (void *dat)
{
  struct kbd_state *kbd = dat;
  int c;
  int kbd_int = 0;
 
  /* Check if there is something waiting, and decode it into kdb_buf */
  if ((c = fgetc (kbd->rxfs)) != EOF)
    {
      scan_decode (kbd, c);
    }
  kbd_int = kbd->kresp
    || kbd->buf_count ? kbd->ccmdbyte & KBD_CCMDBYTE_INT : 0;
/*
  if (config.sim.verbose && kbd_int)
    PRINTF("Keyboard Interrupt.... kbd_kresp %lx  kbd_buf_count %lx \n",
           kbd->kresp, kbd->buf_count);
*/
  if (kbd_int)
    report_interrupt (kbd->irq);
  SCHED_ADD (kbd_job, dat, kbd->slowdown);
}
 
/* Reset all (simulated) ps2 controlers/keyboards */
static void
kbd_reset (void *dat)
{
  struct kbd_state *kbd = dat;
  long int system_kfreq =
    (long) ((1000000000.0 / (double) config.sim.clkcycle_ps));
 
  system_kfreq = (system_kfreq < 1) ? 1 : system_kfreq;
 
  kbd->buf_count = 0;
  kbd->buf_head = 0;
  kbd->buf_tail = 0;
  kbd->kresp = 0x0;
  kbd->ccmdbyte = 0x65;         /* We reset into default normal operation. */
 
  if (!(kbd->rxfs = fopen (kbd->rxfile, "r"))
      && !(kbd->rxfs = fopen (kbd->rxfile, "r+")))
    {
      fprintf (stderr, "WARNING: Unable to open RX file stream.\n");
      return;
    }
  kbd->slowdown = (long) ((system_kfreq * 1000.0) / KBD_BAUD_RATE);
  if (kbd->slowdown <= 0)
    kbd->slowdown = 1;
  SCHED_ADD (kbd_job, dat, kbd->slowdown);
}
 
 
static void
kbd_info (void *dat)
{
  struct kbd_state *kbd = dat;
  PRINTF ("kbd_kcmd: %x\n", kbd->kcmd);
  PRINTF ("kbd_ccmd: %x\n", kbd->ccmd);
  PRINTF ("kbd_ccmdbyte: %x\n", kbd->ccmdbyte);
  PRINTF ("kbd_kresp: %lx\n", kbd->kresp);
  PRINTF ("kbd_buf_count: %lx\n", kbd->buf_count);
}
 
/*----------------------------------------------------[ KBD Configuration ]---*/
 
 
static void
kbd_enabled (union param_val val, void *dat)
{
  struct kbd_state *kbd = dat;
  kbd->enabled = val.int_val;
}
 
 
static void
kbd_baseaddr (union param_val val, void *dat)
{
  struct kbd_state *kbd = dat;
  kbd->baseaddr = val.addr_val;
}
 
 
static void
kbd_irq (union param_val val, void *dat)
{
  struct kbd_state *kbd = dat;
  kbd->irq = val.int_val;
}
 
 
/*---------------------------------------------------------------------------*/
/*!Set the keyboard input file
 
   Free any previously allocated value.
 
   @param[in] val  The value to use
   @param[in] dat  The config data structure                                 */
/*---------------------------------------------------------------------------*/
static void
kbd_rxfile (union param_val val, void *dat)
{
  struct kbd_state *kbd = dat;
 
  if (NULL != kbd->rxfile)
    {
      free (kbd->rxfile);
      kbd->rxfile = NULL;
    }
 
  if (!(kbd->rxfile = strdup (val.str_val)))
    {
      fprintf (stderr, "Peripheral KBD: Run out of memory\n");
      exit (-1);
    }
}                               /* kbd_rxfile() */
 
 
/*---------------------------------------------------------------------------*/
/*!Initialize a new keyboard configuration
 
   ALL parameters are set explicitly to default values.                      */
/*---------------------------------------------------------------------------*/
static void *
kbd_sec_start ()
{
  struct kbd_state *new = malloc (sizeof (struct kbd_state));
 
  if (!new)
    {
      fprintf (stderr, "Peripheral KBD: Run out of memory\n");
      exit (-1);
    }
 
  new->enabled = 1;
  new->baseaddr = 0;
  new->irq = 0;
  new->rxfile = strdup ("kbd_in");
 
  new->buf_count = 0;
  new->buf_head = 0;
  new->buf_tail = 0;
  new->rxfs = NULL;
 
  return new;
 
}                               /* kbd_sec_start() */
 
 
static void
kbd_sec_end (void *dat)
{
  struct kbd_state *kbd = dat;
  struct mem_ops ops;
 
  if (!kbd->enabled)
    {
      free (kbd->rxfile);
      free (kbd);
      return;
    }
 
  memset (&ops, 0, sizeof (struct mem_ops));
 
  ops.readfunc8 = kbd_read8;
  ops.writefunc8 = kbd_write8;
  ops.read_dat8 = dat;
  ops.write_dat8 = dat;
 
  /* FIXME: Correct delay? */
  ops.delayr = 2;
  ops.delayw = 2;
 
  reg_mem_area (kbd->baseaddr, KBD_SPACE, 0, &ops);
  reg_sim_reset (kbd_reset, dat);
  reg_sim_stat (kbd_info, dat);
}
 
void
reg_kbd_sec ()
{
  struct config_section *sec =
    reg_config_sec ("kbd", kbd_sec_start, kbd_sec_end);
 
  reg_config_param (sec, "baseaddr", paramt_addr, kbd_baseaddr);
  reg_config_param (sec, "enabled", paramt_int, kbd_enabled);
  reg_config_param (sec, "irq", paramt_int, kbd_irq);
  reg_config_param (sec, "rxfile", paramt_str, kbd_rxfile);
}

Line No.	Rev	Author	Line
1	805	markom	`/* ps2kbd.c -- Very simple (and limited) PS/2 keyboard simulation`
2	1748	jeremybenn
3	805	markom	`Copyright (C) 2002 Marko Mlinar, markom@opencores.org`
4	1748	jeremybenn	`Copyright (C) 2008 Embecosm Limited`
5	684	lampret
6	1748	jeremybenn	`Contributor Jeremy Bennett <jeremy.bennett@embecosm.com>`
7	805	markom
8	1748	jeremybenn	`This file is part of Or1ksim, the OpenRISC 1000 Architectural Simulator.`
9	805	markom
10	1748	jeremybenn	`This program is free software; you can redistribute it and/or modify it`
11			`under the terms of the GNU General Public License as published by the Free`
12			`Software Foundation; either version 3 of the License, or (at your option)`
13			`any later version.`
14	805	markom
15	1748	jeremybenn	`This program is distributed in the hope that it will be useful, but WITHOUT`
16			`ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or`
17			`FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for`
18			`more details.`
19	805	markom
20	1748	jeremybenn	`You should have received a copy of the GNU General Public License along`
21			`with this program. If not, see <http://www.gnu.org/licenses/>. */`
22	1350	nogj
23	1748	jeremybenn	`/* This program is commented throughout in a fashion suitable for processing`
24			`with Doxygen. */`
25
26
27			`/* Autoconf and/or portability configuration */`
28	1350	nogj	`#include "config.h"`
29	1748	jeremybenn	`#include "port.h"`
30	1350	nogj
31	1748	jeremybenn	`/* System includes */`
32			`#include <stdlib.h>`
33			`#include <stdio.h>`
34	1350	nogj
35	1748	jeremybenn	`/* Package includes */`
36	1350	nogj	`#include "arch.h"`
37	1748	jeremybenn	`#include "pic.h"`
38	805	markom	`#include "sim-config.h"`
39			`#include "abstract.h"`
40			`#include "sched.h"`
41	1748	jeremybenn	`#include "toplevel-support.h"`
42			`#include "sim-cmd.h"`
43	805	markom
44	1748	jeremybenn
45			`/* Device registers */`
46			`#define KBD_CTRL 4`
47			`#define KBD_DATA 0`
48			`#define KBD_SPACE 8`
49
50			`/* Keyboard commands */`
51			`#define KBD_KCMD_RST 0xFF`
52			`#define KBD_KCMD_DK 0xF5`
53			`#define KBD_KCMD_EK 0xF4`
54			`#define KBD_KCMD_ECHO 0xFF`
55			`#define KBD_KCMD_SRL 0xED`
56
57			`/* Keyboard responses */`
58			`#define KBD_KRESP_RSTOK 0xAA`
59			`#define KBD_KRESP_ECHO 0xEE`
60			`#define KBD_KRESP_ACK 0xFA`
61
62			`/* Controller commands */`
63			`#define KBD_CCMD_RCB 0x20`
64			`#define KBD_CCMD_WCB 0x60`
65			`#define KBD_CCMD_ST1 0xAA`
66			`#define KBD_CCMD_ST2 0xAB`
67			`#define KBD_CCMD_DKI 0xAD`
68			`#define KBD_CCMD_EKI 0xAE`
69
70			`/* Status register bits */`
71			`#define KBD_STATUS_OBF 0x01`
72			`#define KBD_STATUS_IBF 0x02`
73			`#define KBD_STATUS_SYS 0x04`
74			`#define KBD_STATUS_A2 0x08`
75			`#define KBD_STATUS_INH 0x10`
76			`#define KBD_STATUS_MOBF 0x20`
77			`#define KBD_STATUS_TO 0x40`
78			`#define KBD_STATUS_PERR 0x80`
79
80			`/* Command byte register bits */`
81			`#define KBD_CCMDBYTE_INT 0x01`
82			`#define KBD_CCMDBYTE_INT2 0x02`
83			`#define KBD_CCMDBYTE_SYS 0x04`
84			`#define KBD_CCMDBYTE_EN 0x10`
85			`#define KBD_CCMDBYTE_EN2 0x20`
86			`#define KBD_CCMDBYTE_XLAT 0x40`
87
88			`/* Length of internal scan code fifo */`
89			`#define KBD_MAX_BUF 0x100`
90
91			`/* Keyboard is checked every KBD_SLOWDOWN cycle */`
92			`#define KBD_BAUD_RATE 1200`
93
94	805	markom	`/* ASCII to scan code conversion table */`
95	1748	jeremybenn	`const static struct`
96			`{`
97	805	markom	`/* Whether shift must be pressed */`
98			`unsigned char shift;`
99			`/* Scan code to be generated */`
100			`unsigned char code;`
101	1748	jeremybenn	`} scan_table[128] =`
102			`{`
103	805	markom	`/* 0 - 15 */`
104	1748	jeremybenn	`{`
105			`0, 0x00},`
106			`{`
107			`0, 0x00},`
108			`{`
109			`0, 0x00},`
110			`{`
111			`0, 0x00},`
112			`{`
113			`0, 0x00},`
114			`{`
115			`0, 0x00},`
116			`{`
117			`0, 0x00},`
118			`{`
119			`0, 0x00},`
120			`{`
121			`0, 0x0E},`
122			`{`
123			`0, 0x0F},`
124			`{`
125			`0, 0x1C},`
126			`{`
127			`0, 0x00},`
128			`{`
129			`0, 0x00},`
130			`{`
131			`0, 0x00},`
132			`{`
133			`0, 0x00},`
134			`{`
135			`0, 0x00},`
136	805	markom	`/* 16 - 31 */`
137	1748	jeremybenn	`{`
138			`0, 0x00},`
139			`{`
140			`0, 0x00},`
141			`{`
142			`0, 0x00},`
143			`{`
144			`0, 0x00},`
145			`{`
146			`0, 0x00},`
147			`{`
148			`0, 0x00},`
149			`{`
150			`0, 0x00},`
151			`{`
152			`0, 0x00},`
153			`{`
154			`0, 0x00},`
155			`{`
156			`0, 0x00},`
157			`{`
158			`0, 0x00},`
159			`{`
160			`0, 0x01},`
161			`{`
162			`0, 0x00},`
163			`{`
164			`0, 0x00},`
165			`{`
166			`0, 0x00},`
167			`{`
168			`0, 0x00},`
169	805	markom	`/* 32 - 47 */`
170	1748	jeremybenn	`{`
171			`0, 0x39},`
172			`{`
173			`1, 0x02},`
174			`{`
175			`1, 0x28},`
176			`{`
177			`1, 0x04},`
178			`{`
179			`1, 0x05},`
180			`{`
181			`1, 0x06},`
182			`{`
183			`1, 0x08},`
184			`{`
185			`0, 0x28},`
186			`{`
187			`1, 0x0A},`
188			`{`
189			`1, 0x0B},`
190			`{`
191			`1, 0x09},`
192			`{`
193			`1, 0x0D},`
194			`{`
195			`0, 0x33},`
196			`{`
197			`0, 0x0C},`
198			`{`
199			`0, 0x34},`
200			`{`
201			`0, 0x35},`
202	805	markom	`/* 48 - 63 */`
203	1748	jeremybenn	`{`
204			`0, 0x0B},`
205			`{`
206			`0, 0x02},`
207			`{`
208			`0, 0x03},`
209			`{`
210			`0, 0x04},`
211			`{`
212			`0, 0x05},`
213			`{`
214			`0, 0x06},`
215			`{`
216			`0, 0x07},`
217			`{`
218			`0, 0x08},`
219			`{`
220			`0, 0x09},`
221			`{`
222			`0, 0x0A},`
223			`{`
224			`1, 0x27},`
225			`{`
226			`0, 0x27},`
227			`{`
228			`1, 0x33},`
229			`{`
230			`0, 0x0D},`
231			`{`
232			`1, 0x34},`
233			`{`
234			`1, 0x35},`
235	805	markom	`/* 64 - 79 */`
236	1748	jeremybenn	`{`
237			`1, 0x03},`
238			`{`
239			`1, 0x1E},`
240			`{`
241			`1, 0x30},`
242			`{`
243			`1, 0x2E},`
244			`{`
245			`1, 0x20},`
246			`{`
247			`1, 0x12},`
248			`{`
249			`1, 0x21},`
250			`{`
251			`1, 0x22},`
252			`{`
253			`1, 0x23},`
254			`{`
255			`1, 0x17},`
256			`{`
257			`1, 0x24},`
258			`{`
259			`1, 0x25},`
260			`{`
261			`1, 0x26},`
262			`{`
263			`1, 0x32},`
264			`{`
265			`1, 0x31},`
266			`{`
267			`1, 0x18},`
268	805	markom	`/* 80 - 95 */`
269	1748	jeremybenn	`{`
270			`1, 0x19},`
271			`{`
272			`1, 0x10},`
273			`{`
274			`1, 0x13},`
275			`{`
276			`1, 0x1F},`
277			`{`
278			`1, 0x14},`
279			`{`
280			`1, 0x16},`
281			`{`
282			`1, 0x2F},`
283			`{`
284			`1, 0x11},`
285			`{`
286			`1, 0x2D},`
287			`{`
288			`1, 0x15},`
289			`{`
290			`1, 0x2C},`
291			`{`
292			`0, 0x1A},`
293			`{`
294			`0, 0x2B},`
295			`{`
296			`0, 0x1B},`
297			`{`
298			`1, 0x07},`
299			`{`
300			`1, 0x0C},`
301	805	markom	`/* 96 - 111 */`
302	1748	jeremybenn	`{`
303			`0, 0x29},`
304			`{`
305			`0, 0x1E},`
306			`{`
307			`0, 0x30},`
308			`{`
309			`0, 0x2E},`
310			`{`
311			`0, 0x20},`
312			`{`
313			`0, 0x12},`
314			`{`
315			`0, 0x21},`
316			`{`
317			`0, 0x22},`
318			`{`
319			`0, 0x23},`
320			`{`
321			`0, 0x17},`
322			`{`
323			`0, 0x24},`
324			`{`
325			`0, 0x25},`
326			`{`
327			`0, 0x26},`
328			`{`
329			`0, 0x32},`
330			`{`
331			`0, 0x31},`
332			`{`
333			`0, 0x18},`
334	805	markom	`/* 112 - 127 */`
335	1748	jeremybenn	`{`
336			`0, 0x19},`
337			`{`
338			`0, 0x10},`
339			`{`
340			`0, 0x13},`
341			`{`
342			`0, 0x1F},`
343			`{`
344			`0, 0x14},`
345			`{`
346			`0, 0x16},`
347			`{`
348			`0, 0x2F},`
349			`{`
350			`0, 0x11},`
351			`{`
352			`0, 0x2D},`
353			`{`
354			`0, 0x15},`
355			`{`
356			`0, 0x2C},`
357			`{`
358			`1, 0x1A},`
359			`{`
360			`1, 0x2B},`
361			`{`
362			`1, 0x1B},`
363			`{`
364			`1, 0x29},`
365			`{`
366			`0, 0x00}`
367	805	markom	`};`
368
369	1748	jeremybenn	`struct kbd_state`
370			`{`
371	1371	nogj	`/* Temporary buffer to store incoming scan codes */`
372			`uint8_t buf[KBD_MAX_BUF];`
373	805	markom
374	1371	nogj	`/* Number of scan codes in buffer */`
375			`unsigned long buf_count;`
376			`unsigned long buf_head;`
377			`unsigned long buf_tail;`
378	805	markom
379	1371	nogj	`/* Input stream */`
380			`FILE *rxfs;`
381	805	markom
382	1371	nogj	`/* Controller Command (write into 0x64) */`
383			`int ccmd;`
384	684	lampret
385	1371	nogj	`/* Keyboard Command (write into 0x60) */`
386			`uint8_t kcmd;`
387	684	lampret
388	1371	nogj	`/* Controller Command Byte */`
389			`uint8_t ccmdbyte;`
390	684	lampret
391	1371	nogj	`/* Keyboard response pending */`
392			`unsigned long kresp;`
393	684	lampret
394	1371	nogj	`/* Keyboard slowdown factor */`
395			`long slowdown;`
396	805	markom
397	1371	nogj	`/* Cofiguration */`
398	1461	nogj	`int enabled;`
399	1371	nogj	`int irq;`
400			`oraddr_t baseaddr;`
401			`char *rxfile;`
402			`};`
403
404	1748	jeremybenn	`static void`
405			`kbd_put (struct kbd_state *kbd, unsigned char c)`
406	805	markom	`{`
407	1748	jeremybenn	`if (kbd->buf_count >= KBD_MAX_BUF)`
408			`{`
409			`fprintf (stderr, "WARNING: Keyboard buffer overflow.\n");`
410			`}`
411			`else`
412			`{`
413			`kbd->buf[kbd->buf_head] = c;`
414			`kbd->buf_head = (kbd->buf_head + 1) % KBD_MAX_BUF;`
415			`kbd->buf_count++;`
416			`}`
417	805	markom	`}`
418
419			`/* Decodes ascii code c into multiple scan codes, placed into buf, length is returned */`
420	1748	jeremybenn	`static void`
421			`scan_decode (struct kbd_state *kbd, unsigned char c)`
422	805	markom	`{`
423			`/* Do not handle special characters and extended ascii */`
424			`if (c >= 128 \|\| !scan_table[c].code)`
425			`return;`
426	1748	jeremybenn
427	805	markom	`/* Make shift? */`
428	1748	jeremybenn	`if (scan_table[c].shift)`
429			`kbd_put (kbd, 0x2a);`
430	805	markom	`/* Make char */`
431	1371	nogj	`kbd_put (kbd, scan_table[c].code);`
432	805	markom	`/* Break char */`
433	1371	nogj	`kbd_put (kbd, scan_table[c].code \| 0x80);`
434	805	markom	`/* Break shift? */`
435	1748	jeremybenn	`if (scan_table[c].shift)`
436			`kbd_put (kbd, 0xaa);`
437	805	markom	`}`
438
439			`/* Write a register */`
440	1748	jeremybenn	`static void`
441			`kbd_write8 (oraddr_t addr, uint8_t value, void *dat)`
442	805	markom	`{`
443	1371	nogj	`struct kbd_state *kbd = dat;`
444	1748	jeremybenn	`switch (addr)`
445			`{`
446	684	lampret	`case KBD_CTRL:`
447	1371	nogj	`kbd->ccmd = value & 0xff;`
448			`if (kbd->ccmd == KBD_CCMD_RCB)`
449	1748	jeremybenn	`kbd->kresp = 0x1;`
450	1371	nogj	`if (kbd->ccmd == KBD_CCMD_ST1)`
451	1748	jeremybenn	`kbd->kresp = 0x1;`
452	1371	nogj	`if (kbd->ccmd == KBD_CCMD_ST2)`
453	1748	jeremybenn	`kbd->kresp = 0x1;`
454			`if (kbd->ccmd == KBD_CCMD_DKI)`
455			`{`
456			`clear_interrupt (kbd->irq);`
457			`kbd->ccmdbyte \|= KBD_CCMDBYTE_EN;`
458			`}`
459	1371	nogj	`if (kbd->ccmd == KBD_CCMD_EKI)`
460	1748	jeremybenn	`kbd->ccmdbyte &= ~KBD_CCMDBYTE_EN;`
461	684	lampret	`if (config.sim.verbose)`
462	1751	jeremybenn	`PRINTF ("kbd_write8(%" PRIxADDR ") %02x\n", addr, value);`
463	805	markom	`break;`
464	684	lampret	`case KBD_DATA:`
465	1748	jeremybenn	`if (kbd->ccmd == KBD_CCMD_WCB)`
466			`{`
467			`kbd->ccmdbyte = value & 0xff;`
468			`kbd->ccmd = 0x00;`
469			`}`
470			`else`
471			`kbd->kcmd = value & 0xff;`
472	1371	nogj	`if (kbd->kcmd == KBD_KCMD_DK)`
473	1748	jeremybenn	`kbd->ccmdbyte \|= KBD_CCMDBYTE_EN;`
474	1371	nogj	`if (kbd->kcmd == KBD_KCMD_EK)`
475	1748	jeremybenn	`kbd->ccmdbyte &= ~KBD_CCMDBYTE_EN;`
476	1371	nogj	`kbd->kresp = 0x1;`
477			`kbd->ccmd = 0x00;`
478	684	lampret	`if (config.sim.verbose)`
479	1751	jeremybenn	`PRINTF ("kbd_write8(%" PRIxADDR ") %02x\n", addr, value);`
480	805	markom	`break;`
481			`default:`
482	1748	jeremybenn	`fprintf (stderr, "Write out of keyboard space (0x%" PRIxADDR ")!\n",`
483			`addr);`
484	805	markom	`break;`
485	1748	jeremybenn	`}`
486	805	markom	`}`
487
488			`/* Read a register */`
489	1748	jeremybenn	`static uint8_t`
490			`kbd_read8 (oraddr_t addr, void *dat)`
491	805	markom	`{`
492	1371	nogj	`struct kbd_state *kbd = dat;`
493	1748	jeremybenn	`switch (addr)`
494			`{`
495			`case KBD_CTRL:`
496			`{`
497			`unsigned long c = 0x0;`
498			`if (kbd->kresp \|\| kbd->buf_count)`
499			`c \|= KBD_STATUS_OBF;`
500			`c \|= kbd->ccmdbyte & KBD_CCMDBYTE_SYS;`

Browse

Tools

Subversion Repositories or1k

[/] [or1k/] [tags/] [rel-0-3-0-rc3/] [or1ksim/] [peripheral/] [ps2kbd.c] - Blame information for rev 1765