blob: af9434bff61a5963336e3651d77f6e4e7b9fdffa (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
|
#include "ballsensor.h"
Ballsensor::Ballsensor() {
// Umrechnungstabelle position i in Winkel
winkel[0] = 0;
winkel[1] = 30;
winkel[2] = 60;
winkel[3] = 100;
winkel[4] = 180;
winkel[5] = 260;
winkel[6] = 300;
winkel[7] = 330;
}
Ballsensor::~Ballsensor() {
}
int Ballsensor::getBallwinkel() {
// Erstelle ein Array für die Sensorwerte
int sensor[NUM_BALLSENSOR];
int result = 0; // und einer Variable fürs Ergebnis
int current = 1024; // Setze aktuellen Wert auf Maximum
// Analoge Sensoren abfragen und eintragen
for(int i=0;i<NUM_BALLSENSOR;i++) sensor[i] = board.GetADC(i);
// Suche den kleinsten Wert
for(int i=0;i<NUM_BALLSENSOR;i++) {
// Wenn der Sensorwert kleiner ist ist der Ball näher dran
if(sensor[i] < current) result = i; // Ergebnis ist erstmal index
}
// Gebe den Winkel zum index result zurück
return winkel[result];
}
|