Subversion Repositories HelenOS-historic

/*

 * Copyright (C) 2006 Martin Decky

 * All rights reserved.

 *

 * Redistribution and use in source and binary forms, with or without

 * modification, are permitted provided that the following conditions

 * are met:

 *

 * - Redistributions of source code must retain the above copyright

 *   notice, this list of conditions and the following disclaimer.

 * - 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.

 * - The name of the author may not be used to endorse or promote products

 *   derived from this software without specific prior written permission.

 *

 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 AUTHOR 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 <arch/drivers/cuda.h>

#include <arch/asm.h>

#include <console/chardev.h>

#include <console/console.h>

#include <arch/drivers/pic.h>

#include <interrupt.h>

#include <stdarg.h>

#define PACKET_ADB  0x00

#define PACKET_CUDA 0x01

#define PACKET_NULL 0xff

#define CUDA_POWERDOWN 0x0a

#define RS 0x200

#define B (0 * RS)

#define A (1 * RS)

#define SR (10 * RS)

#define ACR (11 * RS)

#define SR_OUT 0x10

#define TACK 0x10

#define TIP 0x20

static volatile __u8 *cuda = NULL;

static char lchars[0x80] = {

    'a',  's',  'd',  'f',  'h',  'g',  'z',  'x',  'c',  'v',    0,  'b',  'q',  'w',  'e',  'r',

    'y',  't',  '1',  '2',  '3',  '4',  '6',  '5',  '=',  '9',  '7',  '-',  '8',  '0',  ']',  'o',

    'u',  '[',  'i',  'p',   13,  'l',  'j', '\'',  'k',  ';', '\\',  ',',  '/',  'n',  'm',  '.',

      9,   32,  '`',    8,    0,   27,    0,    0,    0,    0,    0,    0,    0,    0,    0,    0,

      0,  '.',    0,  '*',    0,  '+',    0,    0,    0,    0,    0,  '/',   13,    0,  '-',    0,

      0,    0,  '0',  '1',  '2',  '3',  '4',  '5',  '6',  '7',    0,  '8',  '9',    0,    0,    0,

      0,    0,    0,    0,    0,    0,    0,    0,    0,    0,    0,    0,    0,    0,    0,    0,

      0,    0,    0,    0,    0,    0,    0,    0,    0,    0,    0,    0,    0,    0,    0,    0

};

static void send_packet(const __u8 kind, index_t count, ...)

{

    index_t i;

    va_list va;

    switch (kind) {

        case PACKET_NULL:

            break;

        default:

            cuda[B] = cuda[B] | TIP;

            cuda[ACR] = cuda[ACR] | SR_OUT;

            cuda[SR] = kind;

            cuda[B] = cuda[B] & ~TIP;

            va_start(va, count);

            for (i = 0; i < count; i++) {

                cuda[ACR] = cuda[ACR] | SR_OUT;

                cuda[SR] = va_arg(va, int);

                cuda[B] = cuda[B] | TACK;

            }

            va_end(va);

            cuda[B] = cuda[B] | TIP;

    }

}

static void receive_packet(__u8 *kind, index_t count, __u8 data[])

{

    cuda[B] = cuda[B] & ~TIP;

    *kind = cuda[SR];

    index_t i;

    for (i = 0; i < count; i++)

        data[i] = cuda[SR];

    cuda[B] = cuda[B] | TIP;

}

/* Called from getc(). */

static void cuda_resume(chardev_t *d)

{

}

/* Called from getc(). */

static void cuda_suspend(chardev_t *d)

{

}

static char key_read(chardev_t *d)

{

    char ch;

    ch = 0;

    return ch;

}

static chardev_t kbrd;

static chardev_operations_t ops = {

    .suspend = cuda_suspend,

    .resume = cuda_resume,

    .read = key_read

};

static void cuda_irq(int n, istate_t *istate)

{

    __u8 kind;

    __u8 data[4];

    receive_packet(&kind, 4, data);

    if ((kind == PACKET_ADB) && (data[0] == 0x40) && (data[1] == 0x2c)) {

        __u8 key = data[2];

        if ((key & 0x80) != 0x80)

            chardev_push_character(&kbrd, lchars[key & 0x7f]);

    }

}

void cuda_init(__address base, size_t size)

{

    cuda = (__u8 *) hw_map(base, size);

    int_register(CUDA_IRQ, "cuda", cuda_irq);

    pic_enable_interrupt(CUDA_IRQ);

    chardev_initialize("cuda_kbd", &kbrd, &ops);

    stdin = &kbrd;

}

void cpu_halt(void) {

#ifdef CONFIG_POWEROFF

    send_packet(PACKET_CUDA, 1, CUDA_POWERDOWN);

#else

    send_packet(PACKET_NULL, 0);

#endif

    asm volatile (

        "b 0\n"

    );

}