;********************************************************************* ;* ps2 ;********************************************************************* ;********************************************************************* ;* ;* PS2Reset ;* ;* trash r0 ;* PS2Reset push r1 push r2 movei r2,mPSNormalKeys movei r1,17 moveih r2,>mPSNormalKeys movei r0,0 ;clear all keys PS2ResetLoop subi r1,1 brts PS2ResetLoop st r2,r0 ;delay slot addi r2,1 ;delay slot nop ;delay slot nop ;delay slot ;reset state movei r2,mPS2State movei r1,ePS2StateWait moveih r2,>mPS2State nop st r2,r1 ;epilog rqpop rqpop jmpi r7,0 pop r2 ;delay slot pop r1 ;delay slot nop ;delay slot nop ;delay slot ;********************************************************************* ;* ;* PS2Process ;* PS2Process ;prolog push r0 push r1 push r2 push r3 push r4 push r7 ; movei r2,UcPs2PortACtrl movei r3,mPS2State moveih r2,>UcPs2PortACtrl movei r4,mLastKey ;check ps2 input rqldi r2,0 moveih r3,>mPS2State movei r4,>mLastKey ld r0 ;ps2 data rqldi r3,0 nop nop ld r1 ;state extri r0,8 ;data in available brtc PS2ProcessFinish nop ;delay slot nop ;delay slot moveih r7,$1 ;100 = accept data delay slot moveih r0,0 ;clear upper data of result delay slot st r2,r7 ;write ps2 - accept data st r4,r0 ;store last key ;error check cmpeqi r0,$00 ;key board error brts PS2Reset movei r7,PS2ProcessFinish ;delay slot nop ;delay slot moveih r7,>PS2ProcessFinish ;delay slot nop ;delay slot ;state check cmpeqi r1,ePS2StateWait brts PS2StateWait nop ;delay slot nop ;delay slot nop ;delay slot nop ;delay slot cmpeqi r1,ePS2StateWaitBreak brts PS2StateWaitBreak nop ;delay slot nop ;delay slot nop ;delay slot nop ;delay slot cmpeqi r1,ePS2StateWaitExtended brts PS2StateWaitExtended nop ;delay slot nop ;delay slot nop ;delay slot nop ;delay slot cmpeqi r1,ePS2StateWaitExtendedBreak brts PS2StateWaitExtendedBreak nop ;delay slot nop ;delay slot nop ;delay slot nop ;delay slot PS2ProcessFinish rqpop rqpop rqpop poparqp r7 poparqp r4 poparqp r3 pop r2 pop r1 pop r0 jmpi r7,0 nop ;delay slot nop ;delay slot nop ;delay slot nop ;delay slot ;********************************************************************* ;* ;* PS2TestKey ;* ;* r0 = number to test ;* ;* return ;* ;* r0 = 0 = not pressed / 1 = pressed ;* PS2TestKey push r1 push r2 movei r1,$f movei r2,mPSNormalKeys and r1,r0,r1 ;bit pos moveih r2,>mPSNormalKeys lsri r0,4 ;word pos nop add r2,r2,r0 nop rqldi r2,0 nop nop ld r2 movei r0,1 lsr r2,r2,r1 nop and r0,r2,r0 rqpop rqpop jmpi r7,0 pop r2 ;delay slot pop r1 ;delay slot nop ;delay slot nop ;delay slot ;********************************************************************* ;* ;* PS2ClearKey ;* ;* r0 = number to clear ;* ;* PS2ClearKey push r1 push r2 push r7 gpci r7,2 br PSSetKey movei r2,0 ;reset delay slot movei r1,1 ;delay slot cmploi r2,160 ;delay slot movets r1,r2,r1 ;<160 not extended (0) else 1 delay slot rqpop rqpop rqpop pop r7 pop r2 pop r1 jmpi r7,0 nop ;delay slot nop ;delay slot nop ;delay slot nop ;delay slot ;********************************************************************* ;* ;* PS2StateWait ;* ;* r0 = ps2 data ;* r1 = state ;* r3 = state address PS2StateWait cmpeqi r0,$f0 ;$f0 -> next state = break; brts PS2ProcessFinish movei r1,ePS2StateWaitBreak ;delay slot nop ;delay slot st r3,r1 ;delay slot nop ;delay slot cmpeqi r0,$e0 ;$e0 -> next state = wait extended; brts PS2ProcessFinish movei r1,ePS2StateWaitExtended ;delay slot nop ;delay slot st r3,r1 ;delay slot nop ;delay slot cmpeqi r0,$e1 ;$e1 -> next state = wait extended; brts PS2ProcessFinish movei r1,ePS2StateWaitExtended ;delay slot nop ;delay slot st r3,r1 ;delay slot nop ;delay slot gpci r7,2 ;next 4 + X br PSSetKey nop ;delay slot movei r1,0 ;not extended delay slot movei r2,1 ;set delay slot nop ;delay slot br PS2ProcessFinish movei r1,ePS2StateWait ;else -> next state = wait ;delay slot nop ;delay slot st r3,r1 ;delay slot nop ;delay slot ;********************************************************************* ;* ;* PS2StateWaitBreak ;* ;* r0 = ps2 data ;* r1 = state ;* r3 = state address PS2StateWaitBreak gpci r7,2 ;next 4 + X br PSSetKey nop ;delay slot movei r1,0 ;not extended delay slot movei r2,0 ;clear delay slot nop ;delay slot br PS2ProcessFinish movei r1,ePS2StateWait ;next state = wait ;delay slot nop ;delay slot st r3,r1 ;delay slot nop ;delay slot ;********************************************************************* ;* ;* PS2StateWait ;* ;* r0 = ps2 data ;* r1 = state ;* r3 = state address PS2StateWaitExtended cmpeqi r0,$f0 ;$f0 -> next state = break extended; brts PS2ProcessFinish movei r1,ePS2StateWaitExtendedBreak ;delay slot nop ;delay slot st r3,r1 ;delay slot nop ;delay slot gpci r7,2 ;next 4 + X br PSSetKey nop ;delay slot movei r1,1 ;extended delay slot movei r2,1 ;set delay slot nop ;delay slot br PS2ProcessFinish movei r1,ePS2StateWait ;else -> next state = wait ;delay slot nop ;delay slot st r3,r1 ;delay slot nop ;delay slot ;********************************************************************* ;* ;* PS2StateWaitBreak ;* ;* r0 = ps2 data ;* r1 = state ;* r3 = state address PS2StateWaitExtendedBreak gpci r7,2 ;next 4 + X br PSSetKey nop ;delay slot movei r1,1 ;extended delay slot movei r2,0 ;clear delay slot nop ;delay slot br PS2ProcessFinish movei r1,ePS2StateWait ;next state = wait ;delay slot nop ;delay slot st r3,r1 ;delay slot nop ;delay slot ;********************************************************************* ;* ;* PSSetResetKey ;* ;* r0 = data ;* r1 = 1 = extended ;* r2 = 1 = set / 0 = reset ;* PSSetKey push r0 push r3 push r4 push r5 movei r5,mPSExtendedKeys movei r4,mPSNormalKeys moveih r5,>mPSExtendedKeys moveih r4,>mPSNormalKeys movei r3,$f cmpeqi r1,0 ;0 = normal offset else extended movets r5,r4,r5 ;r5 = src / dest address and r3,r0,r3 ;r3 = low 0..15 (bit pos) lsri r0,4 ;r0 = higher data (word pos) nop add r5,r5,r0 ;add word offset nop rqldi r5,0 ;get word nop nop ld r0 nop or r4,r0,r0 ;r4 bset r0,r3 ;r0 |= 1<