#include "ps2.h"
#include "jtag.h"
-
-u16 mclock=0;
+u32 mclock=0;
u32 clock=0;
// Timer A0 interrupt service routine
int ps2handle(unsigned char app,
unsigned char verb,
unsigned int len){
+
switch(verb){
case START:
WDTCTL = WDTPW + WDTHOLD; // Stop WDT
while((P5IN&TDI));// && P5IN&TDO));
//Transmit the data only if it is new.
-
- if((cmddatalong[0]=clock-oldclock)>0x100)
+ if((clock-oldclock)>0x100){
+ cmddatalong[0]=clock;//-oldclock;
+ cmddatalong[0]-=oldclock;
+ oldclock=clock;
+
txdata(app,verb,4);
- oldclock=clock;
+ }
}
break;
case STOP: