'detect WII I2C controller and read classic controller/nunchuck registers
 'assumes OPTION SYSTEM I2C is set
 
 Option default integer
 Const WII=&h52    'I2C device address
 
 'init
 Dim x(5)
 SetPin gp3,din
 
 'check if connected
 If Pin(gp3)=0 Then Print "no WII device plugged in, exit":End
 
 'yes, go on, find out whay we connected
 Print :Print "Wii device connected"
 init_no_enc
 read_id
 id=((x(2)*256+x(3))*256+x(4))*256+x(5)

 'show device
 select case id
   case &hA4200000
     Print "WII nunchuck plugged in":cont$="WN"
   case &hA4200101
     PRINT "WII classic controller":cont$="WC"
   case else
     print "unknown device, ID = ";hex$(id):cont$="KB"
 end select
 

 if cont$="WN" then  'nunchuck
   print
   Print "X-joy  Y-joy   X-acc   Y-acc   Z-acc  But-C   But-Z"
   
   'main loop
   Do
     'get data from controller
     read_val
     
     'decode data
     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 while inkey$=""
   pause 1:end
 end if
 
 if cont$="WC" then  'WII classic controller
   print
   Print "    L-joy         R-joy       analog trig       direct  contr cluster trigger"
   Print "  X      Y       X      Y     lTrig   rTrig     < > ^ V - H + X Y A B * * l r"
   
   'main loop
   Do
     'get data from controller
     read_val
     
     'decode analog data
     lx=x(0) and 63
     ly=x(1) and 63
     rtx=(x(2)\128)+((x(0) and 192) + ((x(1) and 192)\4))\8
     rty=x(2) and 31
     ltu=((x(2) and 96)+((x(3) and 224)\8))\4
     rtu=x(3) and 31
     
     'decode buttons
     l=(x(5) and 2)\2
     r=x(4)\128
     u=x(5) and 1
     d=(x(4) and 64)\64
     mi=(x(4) and 16)\16
     pl=(x(4) and 4)\4
     xx=(x(5) and 8)\8
     yy=(x(5) and 32)\32
     aa=(x(5) and 16)\16
     bb=(x(5) and 64)\64
     ho=(x(4) and 8)\8
     lt=(x(4) and 32)\32 '=binary representation of ltu
     rt=(x(4) and 2)\2   '=binary representation of rtu
     zl=x(5)\128
     zr=(x(5) and 4)\4
     
     Print lx,ly,rtx,rty,ltu,rtu,  
     print l;r;u;d;mi;ho;pl;xx;yy;aa;bb;lt;rt;zl;zr
     Pause 100
     
   Loop while inkey$=""
   pause 1:end
 end if
 
 
Sub init_no_enc
 I2C write WII,0,2,&h40,&h00
 Pause 10
 I2C write WII,0,2,&hF0,&h55
 I2C write WII,0,2,&hFB,&h00
End Sub
 
Sub read_id
 I2C write WII,0,1,&hFA
 I2C read WII,0,6,x()
End Sub
 
Sub read_val
 I2C write WII,0,1,&h00
 Pause 1 'needed for nunchuck response....
 I2C read WII,0,6,x()
End Sub