Arduino TrackIR

#include "I2Cdev.h"
#include "MPU6050.h"
#include "Wire.h"
#include <Mouse.h>


//Constantes
const int mpuAddress = 0x68;
const int debug = false;

//MODIFICAR SI ES NECESARIO
const float dead_point = 0.0; //Para ajustar un margen de error. Si el ratón se mueve dejando el sensor en una superficie plana incrementar este valor una décima.
const float sensibility = 25;   //establece la sensibilidad. Cuanto mayor sea este número más se moverá el puntero cuando se mueva la cabeza
const int invertX = -1;	//si el ratón se desplaza en el eje X contrario habrá que invertirlo. 1 no invertir, -1 invertir.
const int invertY = -1; //si el ratón se desplaza en el eje Y contrario habrá que invertirlo. 1 no invertir, -1 invertir.


//Objetos
MPU6050 mpu(mpuAddress);    //Your offsets: -2775 1497  1731  78  41  -64

//Variables
int ax, ay, az;
int gx, gy, gz;
float rot_x = 0, rot_y = 0;
float rot_x_prev, rot_y_prev, time_prev;


void setup(){
  Serial.begin(9600);
  Mouse.begin();
  Wire.begin();

  mpu.initialize();

  if(mpu.testConnection() == false){
    Serial.println("MPU fail");
    delay(1000);
    while(true);
  }
}

void loop(){
  mpu.getRotation(&gx, &gy, &gz);

  int differenceTime = millis() - time_prev;
  time_prev = millis();
  rot_x = (gx / 131)*differenceTime / 1000.0 + rot_x_prev; //rotación en X
  rot_y = (gy / 131)*differenceTime / 1000.0 + rot_y_prev; //rotación en Y
  if(abs(rot_x) < dead_point)  //si la rotación es menor al punto muerto no varía
    rot_x = 0;
  if(abs(rot_y) < dead_point)
    rot_y = 0;

  float differenceX = rot_x_prev-rot_x;
  float differenceY = rot_y_prev-rot_y;

  rot_x_prev = rot_x;   //modifica los valores finales
  rot_y_prev = rot_y;

  int desplazarX = 0, desplazarY = 0;

  if(differenceX > dead_point/10 | differenceX < -dead_point/10) //si la diferencia es mayor al punto_muerto/10 establece el desplazamiento del puntero
    desplazarX = differenceX*sensibility;
  if(differenceY > dead_point/10 || differenceY < -dead_point/10)
    desplazarY = differenceY*sensibility;
    
  Mouse.move(desplazarX*invertX, desplazarY*invertY);

  if(debug){
    //Serial.println("sensibility: " + String(sensibility));
    Serial.println("gx: " + String(gx) + " gy: " + String(gy));
    //Serial.println("rot_x: " + String(rot_x) + " rot_y: " + String(rot_y));
    Serial.println("differenceX: " + String(differenceX) + " differenceY: " + String(differenceY));
    //Serial.println("DesplazarX: " + String(desplazarX) + " DesplazarY: " + String(desplazarY));  
  }
}

#include "I2Cdev.h"
#include "MPU6050.h"
#include "Wire.h"
#include <Mouse.h>


//Constantes
const float dead_point = 0.0; //Para ajustar un margen de error. Si el ratón se mueve incrementar este valor
const int mpuAddress = 0x68;

//PINOUT
const int buttonReset = 16;
const int switchOn = 14;
const int switchDCS = 15;
const int switchInvertX = A0;
const int switchInvertY = A1;
const int potSensibility = A3;

const int debug = false;

//Objetos
MPU6050 mpu(mpuAddress);    //Your offsets: -2775 1497  1731  78  41  -64

//Variables
int ax, ay, az;
int gx, gy, gz;
float rot_x = 0, rot_y = 0;
float rot_x_prev, rot_y_prev, time_prev;


void setup(){
  Serial.begin(9600);
  Mouse.begin();
  Wire.begin();

  mpu.initialize();

  if(mpu.testConnection() == false){
    Serial.println("MPU fail");
    delay(1000);
    while(true);
  }
}

void loop(){
  if(digitalRead(switchOn)){
    //Variables necesitadas en la conversión
    float sensibility = map(analogRead(potSensibility), 0, 1023, 1, 100); //establece la sensibilidad como un valor de la lectura del potenciometro
    int invertX = 1, invertY = 1; //si el ratón se desplaza en la coordenada contraria habrá que invertirla. 1 no invertir, -1 invertir.
    
    if(digitalRead(switchInvertX))
      invertX = -1;
    if(digitalRead(switchInvertY))
      invertY = -1;
  
  
    if(digitalRead(buttonReset)){  //RESET
      if(digitalRead(switchDCS)){
        moveToCenterDCS();
      } else {
        moveToCenterScreen();  
      }
      rot_x = 0;
      rot_y = 0;
      rot_x_prev = 0;
      rot_y_prev = 0;
    }
    mpu.getRotation(&gx, &gy, &gz);
  
    int differenceTime = millis() - time_prev;
    time_prev = millis();
    rot_x = (gx / 131)*differenceTime / 1000.0 + rot_x_prev; //rotación en X
    rot_y = (gy / 131)*differenceTime / 1000.0 + rot_y_prev; //rotación en Y
    if(abs(rot_x) < dead_point)  //si la rotación es menor al punto muerto no varía
      rot_x = 0;
    if(abs(rot_y) < dead_point)
      rot_y = 0; 
  
    float differenceX = rot_x_prev-rot_x;
    float differenceY = rot_y_prev-rot_y;
  
    rot_x_prev = rot_x;   //modifica los valores finales
    rot_y_prev = rot_y;
  
  
    int desplazarX = 0, desplazarY = 0;
  
    if(differenceX > dead_point/10 | differenceX < -dead_point/10) //si la diferencia es mayor al punto_muerto/10 establece el desplazamiento del puntero
      desplazarX = differenceX*sensibility;
    if(differenceY > dead_point/10 || differenceY < -dead_point/10)
      desplazarY = differenceY*sensibility;
      
    Mouse.move(desplazarX*invertX, desplazarY*invertY);
  
    if(debug){
      //Serial.println("sensibility: " + String(sensibility));
      Serial.println("gx: " + String(gx) + " gy: " + String(gy));
      //Serial.println("rot_x: " + String(rot_x) + " rot_y: " + String(rot_y));
      Serial.println("differenceX: " + String(differenceX) + " differenceY: " + String(differenceY));
      //Serial.println("DesplazarX: " + String(desplazarX) + " DesplazarY: " + String(desplazarY));  
    }
  }
}

void moveToCenterScreen(){
  //comprobado para un monitor 1920x1080
  for(int i = 0; i < 50; i++){  //esquina superior izquierda
    Mouse.move(-100,-100);
  }
  for(int i = 0; i < 50/2; i++){ //512 saltos de 10 hasta el fin de la pantalla por la derecha
    Mouse.move(100,0); 
  }
  Mouse.move(60,0); 
  for(int i = 0; i < 28/2; i++){ //288 saltos de 10 hasta el fin de la pantalla por la izquierda
    Mouse.move(0,100);  
  }
  Mouse.move(0,38);
}
void moveToCenterDCS(){
  //comprobado para un monitor 1920x1080 y en mi juego según mi configuración.
  for(int i = 0; i < 30; i++){
    Mouse.move(-100,-100);
  }
  delay(20);
  for(int i = 0; i < 10; i++){
    Mouse.move(0,100);
    delay(15);
  }
  for(int i = 0; i < 6; i++){
    Mouse.move(100,0);
    delay(15);
  }
  Mouse.move(50,0);
}