/*
 Example sketch for the Wii Balance Board Bluetooth library - developed by Kristian Lauszus
 For more information visit my blog: http://blog.tkjelectronics.dk/ or
 send me an e-mail:  kristianl@tkjelectronics.com
 */

#include <Wii.h>
#include <usbhub.h>

// Satisfy the IDE, which needs to see the include statment in the ino too.
#ifdef dobogusinclude
#include <spi4teensy3.h>
#include <SPI.h>
#endif

USB Usb;
//USBHub Hub1(&Usb); // Some dongles have a hub inside

BTD Btd(&Usb); // You have to create the Bluetooth Dongle instance like so
/* You can create the instance of the class in two ways */
WII Wii(&Btd, PAIR); // This will start an inquiry and then pair with your Wii Balance Board - you only have to do this once
//WII Wii(&Btd); // After that you can simply create the instance like so and then press the power button on the Wii Balance Board

void setup() {
  Serial.begin(115200);
#if !defined(__MIPSEL__)
  while (!Serial); // Wait for serial port to connect - used on Leonardo, Teensy and other boards with built-in USB CDC serial connection
#endif
  if (Usb.Init() == -1) {
    Serial.print(F("\r\nOSC did not start"));
    while (1); //halt
  }
  Serial.print(F("\r\nWii Balance Board Bluetooth Library Started"));
}
void loop() {
  Usb.Task();
  if (Wii.wiiBalanceBoardConnected) {
    Serial.print(F("\r\ntopRight: "));
    Serial.print(Wii.topRight);
    Serial.print(F("\tbotRight: "));
    Serial.print(Wii.botRight);
    Serial.print(F("\ttopLeft: "));
    Serial.print(Wii.topLeft);
    Serial.print(F("\tbotleft: "));
    Serial.print(Wii.botleft);

    if (Wii.getButtonClick(A)) {
      Serial.print(F("\r\nA"));
      Wii.setLedToggle(LED1);
      //Wii.disconnect();
    }
  }
}