16/modex16/dos_kb.c

   1 /* Thanks to Alex Russell for example code */
   2 /* Thanks to Gary Neal for example code */
   3 #include "dos_kb.h"
   4
   5 // keyboard buffer
   6 static byte key[NUM_SCANCODES]; // pressed
   7 static byte kea[NUM_SCANCODES]; // released
   8
   9 #ifdef __cplusplus              /* Function must be declared C style */
  10 extern "C" {
  11 #endif
  12 static void interrupt (far *oldkb)(void) = NULL; /* BIOS keyboard handler */
  13 #ifdef __cplusplus
  14 }
  15 #endif
  16
  17 /*
  18  * Comment out the following #define if you don't want the testing main()
  19  * to be included.
  20  */
  21 //#define TESTING
  22
  23 /*****************NEW KEYBOARD 09h ISR***********************/
  24 void interrupt newkb(void){
  25         byte kee;
  26         register char qx;
  27
  28         kee = inp(0x60);        /* Read the keyboard scan code */
  29
  30         /* Clear keyboard controller on XT machines */
  31         qx = inp(0x61);    /* Get keyboard control register */
  32         qx |= 0x82;
  33         outp(0x61, qx);    /* Toggle acknowledge bit high */
  34         qx &= 0x7F;
  35         outp(0x61, qx);    /* Toggle acknowledge bit low */
  36
  37         /* Interpret the scan code and set our flags */
  38         #ifdef TESTING
  39         //printf("%d[%d]\n",kee,key[kee]);
  40         #endif
  41         if(kee & 0x80)
  42                 key[kee & 0x7F] = 0; // a key is released
  43         else
  44                 key[kee] = kea[kee] = 1; // a key is pressed
  45
  46         /* Acknowledge the interrupt to the programmable interrupt controller */
  47         outp(0x20, 0x20);      /* Signal non specific end of interrupt */
  48 }
  49
  50 /* ---------------------- init_keyboard() ---------------- April 17,1993 */
  51 /* restore the bios keyboard handler */
  52 /* ---------------------- deinit_keyboard() -------------- April 17,1993 */
  53 void setkb(int vq){
  54         int i;  /* Index variable */
  55         if(!vq){ // deinitiation
  56                 /* Abort if our function pointer has no valid address */
  57                 if(oldkb == NULL) return;
  58                 /* Set address in our function pointer in interrupt vector table */
  59                 _dos_setvect(9, oldkb);
  60                 /* Reset our function pointer to contain no valid address */
  61                 oldkb = NULL;
  62                 #ifdef TESTING
  63                 /* Print the key heap */
  64                 /*printf("\n");
  65                 for(i=0; i<NUM_SCANCODES; i++){
  66                         if(i==NUM_SCANCODES/2) printf("================================\n");
  67                         printf("%03d[%d][%d]",i+1,key[i],kea[i]);
  68                         if(key[i]==1)printf("====");
  69                         printf(",\n");
  70                 }*/
  71                 #endif
  72         }else if(vq == 1){ // initiation
  73                 byte far *lock_key;
  74
  75                 /* Abort if our function pointer has a valid address. */
  76                 if(oldkb != NULL) return;
  77
  78                 /* Clear the keyboard buttons state arrays */
  79                 for(i = 0; i < NUM_SCANCODES; i++)
  80                         key[i] = kea[i] = 0;
  81
  82                 /* save old BIOS key board handler */
  83                 oldkb = _dos_getvect(9);
  84
  85                 // turn off num-lock via BIOS
  86                 lock_key = MK_FP(0x040, 0x017); // Pointing to the address of the bios shift state keys
  87                 *lock_key&=(~(16 | 32 | 64)); // toggle off the locks by changing the values of the 4th, 5th, and 6th bits of the address byte of 0040:0017
  88                 oldkb();        // call BIOS keyhandler to change keyboard lights
  89
  90                 /* setup our own handler */
  91                 _dos_setvect(9, newkb);
  92         }
  93 }
  94
  95 /* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *\
  96  * keyp                                                       *
  97  *                                                                       *
  98  * Returns the status of the key requested.                             *
  99  * The status is 1 if the key is pressed or has been pressed since the     *
 100  * last call to this function for that particular key.               *
 101 \* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
 102 int keyp(byte c){
 103         register char retVal;
 104
 105         /* Key value in range of keyboard keys available */
 106         c &= 0x7F;
 107
 108         /* Get the status of the key requested */
 109         retVal = key[c] | kea[c];
 110
 111         /* Reset the was pressed status for the requested key */
 112         kea[c] = 0;
 113
 114         /* Return the requested key's state */
 115         return retVal;
 116 }
 117
 118
 119 /*
 120  * The library testing routines follows below.
 121  */
 122
 123 #ifdef TESTING
 124
 125 /*
 126  * Library test (program) entry point.
 127  */
 128
 129 void main(void)
 130 {
 131         byte q;
 132         setkb(1);
 133         while(!keyp(1))
 134         {
 135                 keyp(q);
 136         }
 137         setkb(0);
 138 }
 139
 140 #endif