blob: a7bb9fe522a4460a2d23d7201047ae250f9cf64f [file] [log] [blame]
/* LASI PS2 keyboard support code
*
* Copyright (C) 2019 Sven Schnelle <svens@stackframe.org>
*
* This file may be distributed under the terms of the GNU LGPLv2 license.
*/
#include "bregs.h"
#include "autoconf.h"
#include "types.h"
#include "output.h"
#include "hw/ps2port.h"
#include "util.h"
#include "string.h"
#include "lasips2.h"
int lasips2_kbd_in(char *c, int max)
{
struct bregs regs;
volatile int count = 0;
// check if PS2 reported new keys, if so queue them up.
while((gsc_readl(LASIPS2_KBD_STATUS) & LASIPS2_KBD_STATUS_RBNE)) {
process_key(gsc_readb(LASIPS2_KBD_DATA));
}
while(count < max) {
// check if some key is queued up already
regs.ah = 0x11;
regs.flags = 0;
handle_16(&regs);
if (regs.flags & F_ZF) // return if no key queued
break;
// read key from keyboard queue
regs.ah = 0x10;
handle_16(&regs);
if (!regs.ah)
break;
*c++ = regs.ah;
count++;
}
return count;
}
int ps2_kbd_command(int command, u8 *param)
{
return 0;
}
int lasips2_command(u16 cmd)
{
while(gsc_readl(LASIPS2_KBD_STATUS) & LASIPS2_KBD_STATUS_TBNE)
udelay(10);
writeb(LASIPS2_KBD_DATA, cmd & 0xff);
while(!(gsc_readl(LASIPS2_KBD_STATUS) & LASIPS2_KBD_STATUS_RBNE))
udelay(10);
return gsc_readb(LASIPS2_KBD_DATA);
}
void ps2port_setup(void)
{
writeb(LASIPS2_KBD_RESET, 0);
udelay(1000);
writeb(LASIPS2_KBD_CONTROL, LASIPS2_KBD_CONTROL_EN);
lasips2_command(ATKBD_CMD_RESET_BAT);
lasips2_command(ATKBD_CMD_RESET_DIS);
lasips2_command(ATKBD_CMD_SSCANSET);
lasips2_command(0x01);
lasips2_command(ATKBD_CMD_ENABLE);
kbd_init();
}