Arduino code 1
Jump to navigation
Jump to search
#include <Wire.h> #include <MPU6050.h> #include <Servo.h> Servo sg90_x; Servo sg90_y; int servo_x = 2; int servo_y = 10; MPU6050 sensor ; int16_t ax, ay, az ; int16_t gx, gy, gz ; double Setpoint; void setup ( ) { Setpoint = 90; sg90_x.attach (servo_x); sg90_y.attach (servo_y); sg90_x.write(Setpoint); sg90_y.write(Setpoint); Wire.begin( ); Serial.begin (9600); // Serial.println ( "Initializing the sensor" ); sensor.initialize ( ); Serial.println (sensor.testConnection ( ) ? "Successfully Connected" : "Connection failed"); delay (100); } void loop ( ) { sensor.getMotion6 (&ax, &ay, &az, &gx, &gy, &gz); servo_x = map (ax, -17000, 17000, 0, 255) ; servo_y = map(ay, -17000, 17000, 0, 255); sg90_x.write(x_out); sg90_y.write(y_out);