112 lines
3.3 KiB
C++
112 lines
3.3 KiB
C++
/******************************************************************************
|
|
* The MIT License
|
|
*
|
|
* Copyright (c) 2015 Frank-Michael Krause
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person
|
|
* obtaining a copy of this software and associated documentation
|
|
* files (the "Software"), to deal in the Software without
|
|
* restriction, including without limitation the rights to use, copy,
|
|
* modify, merge, publish, distribute, sublicense, and/or sell copies
|
|
* of the Software, and to permit persons to whom the Software is
|
|
* furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be
|
|
* included in all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
|
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
|
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
|
|
* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
|
|
* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
|
|
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
|
* SOFTWARE.
|
|
*****************************************************************************/
|
|
#include <Arduino.h>
|
|
#include <ringbuffer.h>
|
|
#include <lsm303.h>
|
|
|
|
#include <libmaple/i2c.h>
|
|
#include <math.h>
|
|
|
|
|
|
/**
|
|
* Dieses Beispiel wertet die x und y Werte des Beschleunigungssensors aus
|
|
* und zeigt über die 8 LEDs an, in welche Richtung das Board gekippt wurde.
|
|
* Die z-Komponente wird nicht ausgewertet.
|
|
*/
|
|
|
|
|
|
// Array mit den LED-Pins
|
|
int leds[] = { PE9, PE10, PE11, PE12, PE13, PE14, PE15, PE8 };
|
|
|
|
|
|
void setup() // Init-Funktion
|
|
{
|
|
// Die 8 LED-Pins auf Ausgang setzen
|
|
pinMode (leds[0], OUTPUT);
|
|
pinMode (leds[1], OUTPUT);
|
|
pinMode (leds[2], OUTPUT);
|
|
pinMode (leds[3], OUTPUT);
|
|
pinMode (leds[4], OUTPUT);
|
|
pinMode (leds[5], OUTPUT);
|
|
pinMode (leds[6], OUTPUT);
|
|
pinMode (leds[7], OUTPUT);
|
|
|
|
// I2C-Interface initialisieren, mit dem der
|
|
// Beschleunigungssensor verbunden ist
|
|
i2c_master_enable(I2C1, 0);
|
|
|
|
// Beschleunigungssensor initialisieren
|
|
lsm303Init();
|
|
|
|
}
|
|
|
|
// Speicher für die aktuell aktive LED
|
|
int led_idx;
|
|
|
|
void loop()
|
|
{
|
|
float winkel;
|
|
|
|
// Beschleunigungssensor lesen
|
|
readAccValues();
|
|
|
|
// Winkel entsprechend der gemessenen x und y Komponente
|
|
// berechnen
|
|
// atan2 gibt den Winkel im Bogenmass zurueck, 2*Pi entsprechen 360°
|
|
winkel = atan2(accy*-1.0,accx*1.0);
|
|
|
|
// Umrechnung des Winkels auf die 8 LEDs, aus denen der Vollkreis (2*Pi)
|
|
// besteht (Dreisatz, Umrechnung mit 4 und Pi)
|
|
winkel = (winkel*4)/3.14;
|
|
|
|
// Falls der Winkel negativ ist, eine Vollkreis-Wert hinzurechnen
|
|
// für unser Beispiel 8
|
|
if (winkel<0)
|
|
winkel += 8;
|
|
|
|
// alte aktive LED ausschalten
|
|
digitalWrite(leds[led_idx], LOW);
|
|
|
|
// der Ganzzahl-Anteil des Winkels ist der Index der neuen LED
|
|
// Das (int) vor winkel führt die Umwandlung der Kommanzahl in einen Integer-Wert
|
|
// durch. Das nennt man einen Type-Cast. Der ist hier nötig, da eine
|
|
// float Variable nicht direkt einer Integervariable zugewiesen werden kann
|
|
led_idx = (int)winkel;
|
|
|
|
// nochmal prüfen, ob der neue Led-Index nicht zu groß ist
|
|
// wenn ja auf maximalwert setzen
|
|
if (led_idx>7)
|
|
led_idx=7;
|
|
|
|
// neue LED anschalten
|
|
digitalWrite(leds[led_idx], HIGH);
|
|
|
|
delay(50);
|
|
}
|
|
|
|
|
|
|