common update, reorder

[aerei] / esempi / bussola / rgb_states / rgb_states.ino

diff --git a/esempi/bussola/rgb_states/rgb_states.ino b/esempi/bussola/rgb_states/rgb_states.ino
new file mode 100644 (file)
index 0000000..fa03d76
--- /dev/null
+++ b/esempi/bussola/rgb_states/rgb_states.ino
@@ -0,0 +1,96 @@
+/*
+An Arduino code example for interfacing with the HMC5883
+
+by: Jordan McConnell
+ SparkFun Electronics
+ created on: 6/30/11
+ license: OSHW 1.0, http://freedomdefined.org/OSHW
+
+Analog input 4 I2C SDA
+Analog input 5 I2C SCL
+
+Link: https://www.sparkfun.com/tutorials/301
+Datasheet e registri: http://dlnmh9ip6v2uc.cloudfront.net/datasheets/Sensors/Magneto/HMC5883L-FDS.pdf
+*/
+
+#include <Wire.h> //I2C Arduino Library
+#include <common.h> //Libreria comune
+
+#define address 0x1E //0011110b, I2C 7bit address of HMC5883
+
+const byte redPin      = 11;   // 2v a 20ma: che resistenza dovro usare?
+const byte greenPin    = 10;   // 3.5v a 20ma: che resistenza dovro usare?
+const byte bluePin     = 9;    // 3.5v a 20ma: che resistenza dovro usare?
+byte xval ;
+void setup() {
+  //Initialize Serial and I2C communications
+  Serial.begin(9600);
+  Wire.begin();
+
+  //Put the HMC5883 IC into the correct operating mode
+  Wire.beginTransmission(address); //open communication with HMC5883
+  Wire.write(0x00); //select mode Measurement Configuration Bits
+  Wire.write(0x70); // 8 -average, 15 Hz default, normal measuremen
+  Wire.write(0x02); //select mode register
+  Wire.write(0x00); //continuous measurement mode
+  Wire.endTransmission();
+
+  // Cambiare la modalita' di lavoro in Single-Measurement Mode
+  // e farlo leggere ogni ~20ms / 3hz di lettura
+  // Default 15hz = 4ms ; 67ms consigliati
+  // Tra una lettura e l'altra va' in standby
+
+  pinMode(redPin, OUTPUT);
+  pinMode(greenPin, OUTPUT);
+  pinMode(bluePin, OUTPUT);
+}
+
+void loop() {
+
+  int x, y, z ; //triple axis data
+
+  //Tell the HMC5883 where to begin reading data
+  Wire.beginTransmission(address);
+  Wire.write(0x03); //select register 3, X MSB register
+  Wire.endTransmission();
+
+
+  //Read data from each axis, 2 registers per axis
+  Wire.requestFrom(address, 6);
+  if (6 <= Wire.available()) {
+    x = Wire.read() << 8; //X msb
+    x |= Wire.read(); //X lsb
+    z = Wire.read() << 8; //Z msb
+    z |= Wire.read(); //Z lsb
+    y = Wire.read() << 8; //Y msb
+    y |= Wire.read(); //Y lsb
+  }
+  float radianti = atan2(x, y)  ;
+  if (radianti < 0) {// Se y e'antiorario il segno e' inverso
+    radianti += 2 * PI ; // inverte il segno
+  }
+
+   float gradi = radianti * 180 / PI; // Conversione in gradi
+ gradi += 2.56 ; // Correzione per la declinazione magnetica locale
+ // Modena dovrebbe essere a +2° 34' positivi EST
+
+ // LED
+  //xval = cos(map(radianti, 0, 2 * PI, 0, 255));
+  xval = 127 + 127*(cos(radianti)); 
+  analogWrite(redPin, lum(255 - xval)); // Common anodo
+  analogWrite(bluePin, 255);
+  analogWrite(greenPin, 255);
+
+
+ 
+  //Print out values of each axis
+  Serial.print("x: ");
+  Serial.print(x);
+  Serial.print("  radianti: ");
+  Serial.print(cos(radianti));
+  Serial.print("  redval: ");
+  Serial.println(xval);
+
+  delay(100);
+
+}