/*      $NetBSD: cons_zskbd.c,v 1.4 2008/04/28 20:23:18 martin Exp $    */

/*-
 * Copyright (c) 2004, 2005 The NetBSD Foundation, Inc.
 * All rights reserved.
 *
 * This code is derived from software contributed to The NetBSD Foundation
 * by UCHIYAMA Yasushi.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include <sys/param.h>
#include <sys/systm.h>

#include <lib/libsa/stand.h>
#include <lib/libkern/libkern.h>

#include <machine/sbd.h>

#include "console.h"

struct zskbd zskbd;

int zskbd_common_getc(int);
void zskbd_busy(void);

static const uint8_t map_normal[] = {
        '0',    '1',    '2',    '3',    '4',    '5',    '6',    '7',
        '8',    '9',    '-',    '^',    '\\',   ':',    '.',    '/',
        '@',    'a',    'b',    'c',    'd',    'e',    'f',    'g',
        'h',    'i',    'j',    'k',    'l',    'm',    'n',    'o',
        'p',    'q',    'r',    's',    't',    'u',    'v',    'w',
        'x',    'y',    'z',    '[',    ',',    ']',    ';',    0x00,
        '0',    '1',    '2',    '3',    '4',    '5',    '6',    '7',
        '8',    '9',    ' ',    ',',    0x00,   0x00,   0x00,   0x00,
        '\r',   '\r',   0x00,   0x00,   '\r',   0x00,   '-',    '.',
        0xa3,   0xa2,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
        0x08,   0x00,   0x0c,   0x7f,   0x12,   0x00,   0x00,   0x00,
        0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
        0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
        0x00,   0x00,   0xa0,   0xa1,   0x00,   0x00,   0x00,   0x00,
        '+',    '*',    '/',    0x1b,   0x01,   '=',    '\t',   0x00,
        0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
};

static const uint8_t map_shift[] = {
        '0',    '!',    '\"',   '#',    '$',    '%',    '&',    '\'',
        '(',    ')',    '=',    '^',    '|',    '*',    '>',    '?',
        '~',    'A',    'B',    'C',    'D',    'E',    'F',    'G',
        'H',    'I',    'J',    'K',    'L',    'M',    'N',    'O',
        'P',    'Q',    'R',    'S',    'T',    'U',    'V',    'W',
        'X',    'Y',    'Z',    '{',    '<',    '}',    '+',    '_',
        '0',    '1',    '2',    '3',    '4',    '5',    '6',    '7',
        '8',    '9',    ' ',    ',',    0x00,   0x00,   0x00,   0x00,
        '\r',   '\r',   'B',    'C',    '\r',   'E',    '-',    '.',
        0xa3,   0xa2,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
        0x08,   0x00,   0x0b,   0x7f,   0x12,   0x09,   0x00,   0x00,
        0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
        0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
        0x00,   0x00,   0xa0,   0xa1,   0x00,   0x00,   0x00,   0x00,
        '+',    '*',    '/',    0x1b,   0x01,   '=',    '\t',   0x00,
        0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
};

static const uint8_t map_ctrl[] = {
        0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
        0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
        0xa4,   0x01,   0x02,   0x03,   0x04,   0x05,   0x06,   0x07,
        0x08,   0x09,   0x0a,   0x0b,   0x0c,   0x0d,   0x0e,   0x0f,
        0x10,   0x11,   0x12,   0x13,   0x14,   0x15,   0x16,   0x17,
        0x18,   0x19,   0x1a,   0x1b,   0x1c,   0x1d,   0x1e,   0x1f,
        '0',    '1',    '2',    '3',    '4',    '5',    '6',    '7',
        '8',    '9',    ' ',    ',',    0x00,   0x00,   0x00,   0x00,
        '\r',   '\r',   0x00,   0x00,   '\r',   0x00,   '-',    '.',
        0xa3,   0xa2,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
        0x08,   0x00,   0x00,   0x7f,   0x12,   0x00,   0x00,   0x00,
        0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
        0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
        0x00,   0x00,   0xa0,   0xa1,   0x00,   0x00,   0x00,   0x00,
        '+',    '*',    '/',    0x1b,   0x01,   '=',    '\t',   0x00,
        0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
};

static const uint8_t map_capslock[] = {
        '0',    '1',    '2',    '3',    '4',    '5',    '6',    '7',
        '8',    '9',    '-',    '^',    '\\',   ':',    '.',    '/',
        '@',    'A',    'B',    'C',    'D',    'E',    'F',    'G',
        'H',    'I',    'J',    'K',    'L',    'M',    'N',    'O',
        'P',    'Q',    'R',    'S',    'T',    'U',    'V',    'W',
        'X',    'Y',    'Z',    '[',    ',',    ']',    ';',    0x00,
        '0',    '1',    '2',    '3',    '4',    '5',    '6',    '7',
        '8',    '9',    ' ',    ',',    0x00,   0x00,   0x00,   0x00,
        '\r',   '\r',   0x00,   0x00,   '\r',   0x00,   '-',    '.',
        0xa3,   0xa2,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
        0x08,   0x00,   0x0c,   0x7f,   0x12,   0x00,   0x00,   0x00,
        0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
        0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
        0x00,   0x00,   0xa0,   0xa1,   0x00,   0x00,   0x00,   0x00,
        '+',    '*',    '/',    0x1b,   0x01,   '=',    '\t',   0x00,
        0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,   0x00,
};

void
zskbd_set_addr(uint32_t status, uint32_t data)
{
        zskbd.status = (volatile uint8_t *)status;
        zskbd.data = (volatile uint8_t *)data;
        zskbd.normal = map_normal;
        zskbd.shift = map_shift;
        zskbd.ctrl = map_ctrl;
        zskbd.capslock = map_capslock;

        cons.getc = zskbd_getc;
        cons.scan = zskbd_scan;
}

void
zskbd_print_keyscan(int on)
{

        zskbd.print = on;
}

int
zskbd_getc(void)
{

        return zskbd_common_getc(0);
}

int
zskbd_scan(void)
{

        return zskbd_common_getc(1);
}

int
zskbd_common_getc(int scan)
{
#ifdef CHECK_KEY_RELEASE
        static int released = 1;
        int push;
#endif
        int v, c;

        for (;;) {
                if (scan) {
                        if ((*zskbd.status & 0x01) != 0x01)
                                return -1;
                } else {
                        while ((*zskbd.status & 0x01) != 0x01)
                                continue;
                }

                v = *zskbd.data;
                if (zskbd.print)
                        printf("scancode = 0x%x\n", v);

                switch (v) {
                case 123:       /* Shift-L */
                        /* FALLTHROUGH */
                case 124:       /* Shift-R */
                        zskbd.keymap  |= 0x01;
                        break;
                case 251:
                        /* FALLTHROUGH */
                case 252:
                        zskbd.keymap &= ~0x01;
                        break;
                case 120:       /* Ctrl-L */
                        zskbd.keymap |= 0x02;
                        break;
                case 248:
                        zskbd.keymap &= ~0x02;
                        break;
                case 121:       /* CapsLock */
                        if (zskbd.keymap & 0x04) {
                                zskbd.keymap  &= ~0x04;
                                zskbd_busy();
                                *zskbd.data = 0x90; /* LED */
                        } else {
                                zskbd.keymap  |= 0x04;
                                zskbd_busy();
                                *zskbd.data = 0x92; /* LED */
                        }
                        break;
                default:
#ifdef CHECK_KEY_RELEASE
                        push = (v & 0x80) == 0;
                        if (push && released) {
                                released = 0;
                                goto exit_loop;
                        }
                        if (!push)
                                released = 1;
#else /* CHECK_KEY_RELEASE */
                        if ((v & 0x80) == 0)
                                goto exit_loop;
#endif /* CHECK_KEY_RELEASE */
                        break;
                }
        }

 exit_loop:
        c = v & 0x7f;
        if (zskbd.keymap & 0x01)        /* Shift */
                return *(zskbd.shift + c);
        if (zskbd.keymap & 0x02)        /* Ctrl */
                return *(zskbd.ctrl + c);
        if (zskbd.keymap & 0x04)        /* CapsLock */
                return *(zskbd.capslock + c);
                                /* Normal */
        return *(zskbd.normal + c);
}

void
zskbd_busy(void)
{

#if 0 /* I misunderstand??? -uch */
        do {
                while ((*zskbd.status & 0x20) != 0x20)
                        ;
        } while ((*zskbd.status & 0x4) != 0x4);
#endif
}