Add ps2 keyboard initialization.

Which also requires that we properly initialize the i8259 (ISA)
interrupt controller.

1 files changed, 39 insertions, 0 deletions

diff --git a/util.c b/util.c
new file mode 100644
index 0000000..bccd41d
--- /dev/null
+++ b/util.c
@@ -0,0 +1,39 @@
+/* Utility functions for the QEMU PALcode.
+
+   Copyright (C) 2011 Richard Henderson
+
+   This file is part of QEMU PALcode.
+
+   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 text
+   of the GNU General Public License for more details.
+
+   You should have received a copy of the GNU General Public License
+   along with this program; see the file COPYING.  If not see
+   <http://www.gnu.org/licenses/>.  */
+
+#include "protos.h"
+
+
+void
+ndelay(unsigned long nsec)
+{
+  unsigned long target, now;
+
+  now = get_wall_time();
+  target = now + nsec;
+
+  set_alarm_abs(nsec);
+  do
+    {
+      wtint(0);
+      now = get_wall_time();
+    }
+  while (now < target);
+}