#include <Wire.h>
#include <ESP8266WiFi.h>
#include <WiFiUdp.h>
#include <OSCMessage.h>
#include <SPI.h>

const int MPU=0x68;
int16_t AcX,AcY,AcZ;

char ssid[] = "NETGEAR41";
char pass[] = "magicalbanana0";

WiFiUDP Udp;
const IPAddress outIp(192,168,0,29);   // remote IP of receiver computer
const unsigned int outPort = 7000;     // remote port to receive OSC

void setup() {
  
  Wire.begin();
  Wire.beginTransmission(MPU);
  Wire.write(0x6B);
  Wire.write(0);
  Wire.endTransmission(true);
  
  Serial.begin(115200);

  Serial.print("Connecting to ");
  Serial.println(ssid);
  WiFi.begin(ssid, pass);

  while (WiFi.status() != WL_CONNECTED) {
    delay(500);
    Serial.print(".");
  }

  Serial.println("");
  Serial.println("WiFi connected");
  Serial.println("IP address: ");
  Serial.println(WiFi.localIP());

}

void loop() {

  Wire.beginTransmission(MPU);
  Wire.write(0x3B);  
  Wire.endTransmission(false);
  Wire.requestFrom(MPU,14);  
  AcX=Wire.read()<<8|Wire.read();
  AcY=Wire.read()<<8|Wire.read();  
  AcZ=Wire.read()<<8|Wire.read();  
  
  Serial.print(AcX);
  Serial.print("\t"); 
  Serial.print(AcY);
  Serial.print("\t"); 
  Serial.println(AcZ);

  OSCMessage msgRX("/movedulation/sliderRX");
  msgRX.add(AcX);
  Udp.beginPacket(outIp, outPort);
  msgRX.send(Udp);
  Udp.endPacket();
  msgRX.empty();
  
  OSCMessage msgRY("/movedulation/sliderRY");
  msgRY.add(AcY);
  Udp.beginPacket(outIp, outPort);
  msgRY.send(Udp);
  Udp.endPacket();
  msgRX.empty();

  
  delay(100);
}