@@ -35,18 +35,7 @@
lcd.setCursor(0,3);
- lcd.write(byte(0));
- delay(2000);
- lcd.write(byte(1));
- lcd.write(byte(2));
- lcd.write(byte(3));
- lcd.write(byte(4));
- lcd.write(byte(5));
+
@@ -7,11 +7,11 @@
y = compass.getY();
z = compass.getZ();
- if (Math.atan2(y, x) >= 0) {
- angle = Math.atan2(y, x) * (180 / Math.PI);
+ if (atan2(y, x) >= 0) {
+ angle = atan2(y, x) * (180 / PI);
}
else {
- angle = (Math.atan2(y, x) + 2 * Math.PI) * (180 / Math.PI);
+ angle = (atan2(y, x) + 2 * PI) * (180 / PI);
@@ -137,20 +137,8 @@ if ( t < millis() ) {
//u8x8.drawTile(0, U8LOG_HEIGHT+1, 1, tiles);
#if defined(HAS_QMC5883LCompass)
- int x, y, z;
- Serial.println();
- // Read compass values
- compass.read();
-
- x = compass.getX();
- y = compass.getY();
- z = compass.getZ();
- // SPFT(compass);
- // SPFT2(X,x);
- // SPFT(Y);
- // SP(y);
- // SPFT(Z);
- // SP(z);
+ #include "compass__loop.h"
#endif
#if defined(HAS_MPU6050)
accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
@@ -1,2 +1,2 @@
-const char text[] = "Hello World";
+const char text[] = "testP5";
radio.write(&text, sizeof(text));