Code
#include
#include
/*
* WiiChuck torentje--
*
* 2011 Luke Cudnik
*
*/
#include
#include "nunchuck_funcs.h"
int loop_cnt = 0;
Servo s1;
Servo s2;
byte-accx, accy, zbut, cbut;
int ledPin = 13;
VOID Setup
{
pinMode (11, OUTPUT);
Serial.begin(19200);
nunchuck_setpowerpins();
nunchuck_init(); Stuur de handdruk initilization
S1.attach(6);
S2.attach(8);
Serial.Print ("WiiChuckDemo ready\n");
}
void loop
{
Als (loop_cnt > 100) {/ / elke 100 msec krijgen nieuwe gegevens
loop_cnt = 0;
nunchuck_get_data();
accx = nunchuck_joyx(); varieert van ongeveer 70-182
accy = nunchuck_joyy(); varieert van ongeveer 65-173
zbut = nunchuck_zbutton();
cbut = nunchuck_cbutton();
int ax = map(accx,30,230,1,180);
int ay = map(accy,30,230,1,180);
Serial.Print ("accx:");
Serial.Print((byte)accx,DEC);
Serial.Print ("\taccy:");
Serial.Print((byte)accy,DEC);
Serial.Print ("\tzbut:");
Serial.Print((byte)zbut,DEC);
Serial.Print ("\tcbut:");
Serial.println((byte)cbut,DEC);
Serial.Print ("\ax:");
Serial.println((byte)AX,DEC);
Serial.Print ("\ay:");
Serial.println((byte)ay,DEC);
Als (cbut == 1) {}
S1.write(90);
S2.write(90);
}
Als (cbut == 0) {}
Als ((ax<80) of (ax > 100)) {}
S1.write(AX);
}
else {}
S1.write(90);
}
}
Als (cbut == 0) {}
Als ((ay<80) of (ay > 100)) {}
S2.write(ay);
}
else {}
S2.write(90);
}
}
}
Als (zbut == 1) {}
digitalWrite (11, hoge);
}
Als (zbut == 0) {}
digitalWrite (11, laag);
}
loop_cnt ++;
delay(1);
}