#include <Servo.h> 
#include <Wire.h>
#include <ArduinoNunchuk.h>

#define BAUDRATE 19200

ArduinoNunchuk nunchuk = ArduinoNunchuk(); 
Servo myservo;  
Servo myservo2; 
int pos = 0;    
 
void setup() 
{ 
  Serial.begin(BAUDRATE);
  nunchuk.init(); 
  myservo.attach(6);
 myservo2.attach(5);  
} 
 
void loop() 
{ 

  
  nunchuk.update();
   Serial.print(nunchuk.analogX, DEC);
  Serial.print(' ');
  Serial.print(nunchuk.analogY, DEC);
  Serial.print(' ');
  Serial.print(nunchuk.accelX, DEC);
  Serial.print(' ');
  Serial.print(nunchuk.accelY, DEC);
  Serial.print(' ');
  Serial.print(nunchuk.accelZ, DEC);
  Serial.print(' ');
  Serial.print(nunchuk.zButton, DEC);
  Serial.print(' ');
  Serial.println(nunchuk.cButton, DEC);
  
  if(!nunchuk.zButton)
  {
    myservo.write(map(nunchuk.analogX,0,255,0,180)); 
    myservo2.write(map(nunchuk.analogY,0,255,0,180)); 

    delay(30);   
  }
  else
  
  {
    
    
    myservo.write(map(constrain(nunchuk.accelX,320,760),320,760,0,180));
     myservo2.write(map(constrain(nunchuk.accelY,320,760),320,760,0,180));
      delay(30); 
  }

 
  
}