git.rot13.org Git - goodfet/blob - firmware/apps/plugins/ps2.c

   1 /*! \file glitch.c
   2   \author Travis Goodspeed
   3   \brief PS2 Timing Monitor for GoodFET
   4
   5   This module spies on PS/2.  For now, it just reports the
   6   inter-character timing information.
   7 */
   8
   9 #include "platform.h"
  10 #include "command.h"
  11 #include "ps2.h"
  12 #include "jtag.h"
  13
  14
  15 u32 mclock=0;
  16 u32 clock=0;
  17
  18 // Timer A0 interrupt service routine
  19 interrupt(TIMERA0_VECTOR) Timer_A (void)
  20 {
  21   if(!clock++)
  22     mclock++;
  23   return;
  24 }
  25
  26
  27
  28 /** Pins (Clk, Dat)
  29     TDI P5.1
  30     TDO P5.2
  31 */
  32
  33 // This is just a plugin for now.
  34 #define ps2handle pluginhandle
  35
  36 u32 oldclock=0;
  37 //! Handles a monitor command.
  38 int ps2handle(unsigned char app,
  39               unsigned char verb,
  40               unsigned int len){
  41
  42   switch(verb){
  43   case START:
  44     WDTCTL = WDTPW + WDTHOLD;             // Stop WDT
  45     TACTL = TASSEL1 + TACLR;              // SMCLK, clear TAR
  46     CCTL0 = CCIE;                         // CCR0 interrupt enabled
  47     CCR0 = 0x100; //clock divider
  48     TACTL |= MC_3;
  49     _EINT();                              // Enable interrupts
  50
  51
  52     P5DIR&=~(TDI+TDO);//input mode
  53     P5OUT=0; // pull down
  54
  55     debugstr("Waiting for a keypress.");
  56     //Wait for a keypress.
  57
  58     while(1){
  59       //Debounce the 1s polling
  60       while((P5IN&TDI && P5IN&TDO))
  61         while((P5IN&TDI));// && P5IN&TDO));
  62
  63       //Transmit the data only if it is new.
  64       if((clock-oldclock)>0x100){
  65         cmddatalong[0]=clock;//-oldclock;
  66         cmddatalong[0]-=oldclock;
  67         oldclock=clock;
  68
  69         txdata(app,verb,4);
  70       }
  71     }
  72     break;
  73   case STOP:
  74   default:
  75     debugstr("Unknown ps2 verb.");
  76     txdata(app,NOK,0);
  77   }
  78 }