'read nunchuck registers
'assumes OPTION SYSTEM I2C is set

option default integer
const nunch=&h52    'I2C device address

'init
dim x(5)
setpin gp3,din

'check if connected
if pin(gp3)=0 then print "no WII nunchuck plugged in, exit":end

'yes, go on
print:print "Wii device connected"
init_no_enc
read_id
id=((x(2)*256+x(3))*256+x(4))*256+x(5)
print "device = &h";hex$(id)
if id=&hA4200000 then print "WII nunchuck plugged in":print

print "X-joy  Y-joy   X-acc   Y-acc   Z-acc  But-C   But-Z"

'main loop
do
 read_val
 xa=4*x(2) + ((x(5)and &b11000000)>>6)
 ya=4*x(3) + ((x(5)and &b00110000)>>4)
 za=4*x(4) + ((x(5)and &b00001100)>>2)
 c_but=(x(5)and &b00000010)>>1
 z_but=(x(5)and &b00000001)
 print x(0),x(1),xa,ya,za,c_but,z_but
 pause 100
loop

sub init_no_enc
 I2C write nunch,0,2,&h40,&h00
 pause 10
 I2C write nunch,0,2,&hF0,&h55
 I2C write nunch,0,2,&hFB,&h00  
end sub

sub read_id
 I2C write nunch,0,1,&hFA
 I2C read nunch,0,6,x()
end sub

sub read_val
 I2C write nunch,0,1,&h00
 pause 1 'needed for nunchuck response....
 I2C read nunch,0,6,x()
end sub