Hi guys, this Code i got from internet is a headtracker relative steer but for adafruit BNO005 on Arduino micro and i have mpu6050 on Arduino micro....
I need that if i tilt the head a little bit to right for ex It Will tilt the mouse endless till you center head on screen again
Can you help me to change libraries and code to use on mpu6050 please? Thanks!!!!!!
#include <Wire.h>
#include <Adafruit_Sensor.h>
#include <Adafruit_BNO055.h>
#include <utility/imumaths.h>
/* Set the delay between fresh samples EXPECT HIGH REFRESH*/
#define BNO055_SAMPLERATE_DELAY_MS (10)
float horizontal_angle = 0;
float horizontal_offset = 0;
float verticle_angle = 0;
float verticle_offset = 0;
const int buttonGndPin = 6;
const int buttonPin = 7;
int buttonState = 0;
int prevButtonState = 0;
int incoming = 0;
Adafruit_BNO055 bno = Adafruit_BNO055(55);
void displaySensorDetails(void)
{
sensor_t sensor;
bno.getSensor(&sensor);
Serial.println("------------------------------------");
Serial.print ("Sensor: "); Serial.println(sensor.name);
Serial.print ("Driver Ver: "); Serial.println(sensor.version);
Serial.print ("Unique ID: "); Serial.println(sensor.sensor_id);
Serial.print ("Max Value: "); Serial.print(sensor.max_value); Serial.println(" xxx");
Serial.print ("Min Value: "); Serial.print(sensor.min_value); Serial.println(" xxx");
Serial.print ("Resolution: "); Serial.print(sensor.resolution); Serial.println(" xxx");
Serial.println("------------------------------------");
Serial.println("");
Serial.println("waiting 2 seconds");
delay(2000);
}
/**************************************************************************/
/*
Arduino setup function (automatically called at startup)
*/
/**************************************************************************/
void setup(void)
{
Serial.begin(9600);
Serial.println("\r\nORIENTATION SENSOR STARTED");
delay(1000);
/* Initialise the sensor */
if(!bno.begin())
{
/* There was a problem detecting the BNO055 ... check your connections */
Serial.print("Ooops, no BNO055 detected ... Check your wiring or I2C ADDR!");
while(1);
}
delay(1000);
/* Display some basic information on this sensor */
displaySensorDetails();
bno.setExtCrystalUse(true);
pinMode(buttonGndPin, OUTPUT);
digitalWrite(buttonGndPin, LOW);
pinMode(buttonPin, INPUT);
delay(3000);
Mouse.begin();
}
/**************************************************************************/
/*
Arduino loop function, called once 'setup' is complete (your own code
should go here)
*/
/**************************************************************************/
void loop(void)
{
/* Get a new sensor event */
sensors_event_t event;
bno.getEvent(&event);
//CONVERT OUTPUT FROM Adafruit_BNO055
//**************************************************
if(event.orientation.x > 180){
horizontal_angle = (event.orientation.x -360) + horizontal_offset;
}else{
horizontal_angle = event.orientation.x + horizontal_offset;
}
verticle_angle = event.orientation.y + verticle_offset;
//CONVERT OUTPUT FROM Adafruit_BNO055
//get current button state
buttonState = digitalRead(buttonPin);
//DISPLAY DATA FROM Adafruit_BNO055
//*************************************************************
Serial.print("X: ");
Serial.print(event.orientation.x, 4);
Serial.print(" horizontal angle: ");
Serial.print(horizontal_angle, 4);
Serial.print(" horizontal offest: ");
Serial.print(horizontal_offset, 4);
Serial.print(" Y: ");
Serial.print(event.orientation.y, 4);
Serial.print(" verticle angle: ");
Serial.print(verticle_angle, 4);
Serial.print(" verticle offest: ");
Serial.print(verticle_offset, 4);
Serial.print(" Z: ");
Serial.print(event.orientation.z, 4);
Serial.print(" button: ");
Serial.print(buttonState);
Serial.print(" millis:: ");
Serial.print(millis());
Serial.println("");
//ACT ON DATA
//************************************************************
//if button is on then move mouse
if(buttonState==1){
Mouse.move((int)horizontal_angle, (int)verticle_angle, 0);
}
//check that the button was off but is now on (change of state)
if(buttonState==1&&prevButtonState==0){
Serial.println("RESET CENTER");
if(event.orientation.x > 180){
horizontal_offset = -(event.orientation.x -360);
}else{
horizontal_offset = -event.orientation.x;
}
verticle_offset = -(event.orientation.y);
}
//save the current button state for the next loop
prevButtonState = buttonState;
//************************************************************
delay(BNO055_SAMPLERATE_DELAY_MS);
}
