Lynxmotion Tech Support

'{$STAMP BS2}
clk CON 7
att CON 6
dat CON 4
cmd CON 5
PS2B1 VAR Byte
PS2B2 VAR Byte
PS2B3 VAR Byte
PS2B4 VAR Byte
PS2B5 VAR Byte
PS2B6 VAR Byte
char VAR Byte
temp1 VAR Word
temp2 VAR Word
temp3 VAR Byte

' Read PS2 Controller
read_PS2

LOW att

SHIFTOUT cmd, clk, LSBFIRST, [$01,$42]
SHIFTIN dat, clk, 3, [char]
temp3 = char

SHIFTIN dat, clk, 3, [char]
PS2B1 = char

SHIFTIN dat, clk, 3, [char]
PS2B2 = char

SHIFTIN dat, clk, 3, [char]
PS2B3 = char

SHIFTIN dat, clk, 3, [char]
PS2B4 = char

SHIFTIN dat, clk, 3, [char]
PS2B5 = char

SHIFTIN dat, clk, 3, [char]
PS2B6 = char

HIGH att

temp1 = ((PS2B3 * 4) + 250) MIN 350 MAX 1150 'MIN 250 MAX 1250
temp2 = ((PS2B4 * 4) + 250) MIN 350 MAX 1150 'MIN 250 MAX 1250

PULSOUT 12, temp1
PULSOUT 13, temp2
PAUSE 20

' DEBUG DEC temp1, " ", DEC PS2B3, " ", DEC temp2, " ", DEC PS2B4, CR
' debug dec temp3, " ", cr
' DEBUG BIN PS2B1, " ", BIN PS2B2, " ", DEC PS2B3, " ", DEC PS2B4, " ", DEC PS2B5, " ", DEC PS2B6, CR

exit_read_PS2

GOTO read_PS2

RETURN