/* ambaKbd.c - ARM AMBA keyboard driver routines *//* Copyright 1993-2001 Wind River System, Inc. */#include "copyright_wrs.h"/*modification history--------------------01b,20sep02,wdf  Removed include of bspExt header files.01a,06jul01,m_h  created.*//*DESCRIPTIONThis is the driver for ARM's AMBA PrimeCell keyboard controller chip. This driverhandles the standard 101 keyboard.NOTESThe following macros must be defined in ambakmi.h file: COMMAND_AMBA_KB,DATA_AMBA_KB, STATUS_AMBA_KB. These refer to the I/O base addresses of the various keyboard controller registers. In addition, the macro KBD_INT_LVL and KBD_INT_VEC must be defined that identifies the interrupt level and vector that is to be used for the mouse interrupts.  Also the I/O access method requires that the macros KBD_IN and KBD_OUT be defined.Warning: Use kbdIntDisable() to disable interrupts while sending commands to thekeyboard.  Otherwise the KMI keyboard interface chip will no longer produce rxinterrupts.  Use kbdIntEnable() to reenable the interrupts.*//* includes */#include "vxWorks.h"#include "iv.h"#include "ioLib.h"#include "iosLib.h"#include "memLib.h"#include "errnoLib.h"#include "wdLib.h"#include "sysLib.h"#include "intLib.h"#include "taskLib.h"#include "ambakmi.h"#include "ugl/sysWindML.h"#if 0LOCAL KBD_DEVICE   *  pKbdDevice;    /* device descriptors */void      at91ckbdIntr (void);#endifLOCAL UCHAR  scanCode;   /* to hold the scanCode */LOCAL UCHAR kbdBitCnt = 0;LOCAL UCHAR kbdParity;LOCAL UCHAR kbdByte2;LOCAL UCHAR kbdParity2 = 1;LOCAL UCHAR kbdBitCnt2 =0;/*lab used for ack receivelab=0,use int to send data lab =1,wait for an acklab =2 ,rec data */LOCAL UCHAR kbdLab =2;	LOCAL UCHAR     oldLedStat = 0;/* forward declarations */LOCAL void      kbdLedSet (void);LOCAL void      kbdWdog (void);LOCAL int       kbdWriteData (KBD_DEVICE * pKbdDv);LOCAL int       kbdDrvOpen ();LOCAL STATUS    kbdDrvIoctl (KBD_DEVICE * pKbdDv, int request, int arg);LOCAL void      kbdDrvHwInit (void);LOCAL void      kbdHwInit (void);LOCAL void      kbdDelay (void);LOCAL void kbdWaitForCLK(int value);LOCAL void kbdWriteBit(UCHAR b)	;KBD_DEVICE   *  pKbdDevice;    /* device descriptors *//* scan code->key number conversion table for *  an extended AT keyboard in mode 2 */int scanmap_mode2[256] =    {    0,    /*  0   */    120,  /*  1   */               0,    /*  2   */               116,  /*  3   */               114,  /*  4   */               112,  /*  5   */               113,  /*  6   */               123,  /*  7   */               0,    /*  8   */               121,  /*  9   */               119,  /*  A   */               117,  /*  B   */               115,  /*  C   */               16,   /*  D   */               1,    /*  E   */               0,    /*  F   */               0,    /*  10  */               60,   /*  11  */               44,   /*  12  */               0,    /*  13  */               58,   /*  14  */               17,   /*  15  */               2,    /*  16  */               0,    /*  17  */               0,    /*  18  */               0,    /*  19  */               46,   /*  1A  */               32,   /*  1B  */               31,   /*  1C  */               18,   /*  1D  */               3,    /*  1E  */               128,  /*  1F  */               0,    /*  20  */               48,   /*  21  */               47,   /*  22  */               33,   /*  23  */               19,   /*  24  */               5,    /*  25  */               4,    /*  26  */               129,  /*  27  */               0,    /*  28  */               61,   /*  29  */               49,   /*  2A  */               34,   /*  2B  */               21,   /*  2C  */               20,   /*  2D  */               6,    /*  2E  */               130,  /*  2F  */               0,    /*  30  */               51,   /*  31  */               50,   /*  32  */               36,   /*  33  */               35,   /*  34  */               22,   /*  35  */               7,    /*  36  */               0,    /*  37  */               0,    /*  38  */               0,    /*  39  */               52,   /*  3A  */               37,   /*  3B  */               23,   /*  3C  */               8,    /*  3D  */               9,    /*  3E  */               0,    /*  3F  */               0,    /*  40  */               53,   /*  41  */               38,   /*  42  */               24,   /*  43  */               25,   /*  44  */               11,   /*  45  */               10,   /*  46  */               0,    /*  47  */               0,    /*  48  */               54,   /*  49  */               55,   /*  4A  */               39,   /*  4B  */               40,   /*  4C  */               26,   /*  4D  */               12,   /*  4E  */               0,    /*  4F  */               0,    /*  50  */               0,    /*  51  */               41,   /*  52  */               0,    /*  53  */               27,   /*  54  */               13,   /*  55  */               0,    /*  56  */               0,    /*  57  */               30,   /*  58  */               57,   /*  59  */               43,   /*  5A  */               28,   /*  5B  */               0,    /*  5C  */               29,   /*  5D  */               0,    /*  5E  */               0,    /*  5F  */               0,    /*  60  */               45,   /*  61  */               0,    /*  62  */               0,    /*  63  */               0,    /*  64  */               0,    /*  65  */               15,   /*  66  */               0,    /*  67  */               0,    /*  68  */               93,   /*  69  */               0,    /*  6A  */               92,   /*  6B  */               91,   /*  6C  */               0,    /*  6D  */               0,    /*  6E  */               0,    /*  6F  */               99,   /*  70  */               104,  /*  71  */               98,   /*  72  */               97,   /*  73  */               102,  /*  74  */               96,   /*  75  */               110,  /*  76  */               90,   /*  77  */               122,  /*  78  */               106,  /*  79  */               103,  /*  7A  */               105,  /*  7B  */               100,  /*  7C  */               101,  /*  7D  */               125,  /*  7E  */               0,    /*  7F  */               0,    /*  80  */               0,    /*  81  */               0,    /*  82  */               118,  /*  83  */               0,    /*  84  */               0,    /*  85  */    0,    /*  86  */    0,    /*  87  */    0,    /*  88  */    0,    /*  89  */    0,    /*  8A  */    0,    /*  8B  */    0,    /*  8C  */    0,    /*  8D  */    0,    /*  8E  */    0,    /*  8F  */    /* no keys with codes > 0x8F */    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,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,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,0,0,0,0,0,0,0    };/******************************************************************************** ambaKbdDevCreate - create a device for the on-board ports** This routine creates a device on the AMBA keyboard port.  Each port* to be used should have only one device associated with it, by calling* this routine.** RETURNS: OK, or ERROR if there is no driver or one already exists for the* specified port.*/STATUS at91cKbdDevCreate    (    char *  name       /* name to use for this device */    )    {    int        kbdDrvNum;      /* driver number assigned to this driver */    DEV_HDR   *pHdr;    char      *pName;    WINDML_DEVICE *pDev;   printf("at91cKbdDevCreate1\n");    /* if device is already present, do not create again */    pHdr = iosDevFind (name, &pName);	printf("at91cKbdDevCreate2\n");    if ((pHdr != NULL) && (strcmp (name, pHdr->name) == 0))        {        pKbdDevice = (KBD_DEVICE *)pHdr;        return (OK);        }        pKbdDevice = (KBD_DEVICE *)malloc (sizeof (KBD_DEVICE));    pKbdDevice->kbdFlags = 0;    /* enable the keybord interrupt */        pDev = sysWindMLDevGet (WINDML_KEYBOARD_DEVICE, 0, 0, 0);/*中斷處理在鼠標中連接*//*    kbdDrvHwInit ();*/    kbdHwInit ();    kbdDrvNum = iosDrvInstall (kbdDrvOpen, (FUNCPTR) NULL, kbdDrvOpen,                    (FUNCPTR) NULL, tyRead, tyWrite, kbdDrvIoctl);    if (kbdDrvNum == ERROR)        {        return (ERROR);        }    if (tyDevInit (&pKbdDevice->tyDev, 20, 10, kbdWriteData)        != OK)        {        return (ERROR);        }/*INT enable is later enable */    /* add the device to the I/O system */    return (iosDevAdd (&pKbdDevice->tyDev.devHdr, name, kbdDrvNum));    }/******************************************************************************** kbdDrvHwInit - initialize the Keyboard*/LOCAL void kbdDrvHwInit (void)    {    FAST int    oldlevel;   /* to hold the oldlevel of interrupt */    oldlevel= intLock ();    /* Keyboard initialization */    kbdHwInit ();    /* interrupt is masked out: the keyboard interrupt will be enabled     * in the kbdDevCreate      */    intUnlock (oldlevel);    }/********************************************************************************* kbdDrvOpen - open file to Console**/LOCAL int kbdDrvOpen     (    KBD_DEVICE *    pKbdDv,    char *          name,    int             mode    )    {    return ((int) pKbdDv);    }/********************************************************************************* kbdDrvIoctl - special device control** This routine handles FIOGETOPT requests and passes all others to tyIoctl.** RETURNS: OK or ERROR if invalid baud rate, or whatever tyIoctl returns.*/LOCAL STATUS kbdDrvIoctl     (    KBD_DEVICE *    pKbdDv,    /* device to control */    int             request,    /* request code */    int             arg         /* some argument */    )    {    int     status = OK;    switch (request)        {            case CONIOCURCONSOLE:   /* change current console */            break;        case CONIOCONVERTSCAN:      /* send scan codes vs. ASCII */            break;        case CONIOLEDS:         /* change LEDs */            pKbdDv->kbdFlags = arg;