Hallo Leute,
ich sitze schon Ewigkeiten an meinem RAZOR 9DOF und habe Probleme mit
dem Gyroskopen(Ly530ALH). Ich habe den Selftest so verstanden, dass ich
die ST Verbindung auf HIGH setze und sich der DC Level verändert. aber
irgendwie ist da kein Unterschied zu ST-->LOW
Kann mir von euch einer helfen? Anbei nochmal der Code
schon einmal danke im Vorraus
Lg Daniel
1 | #define ST 32
|
2 | #define X_OUT 24
|
3 | #define Y_OUT 25
|
4 | #define Z_OUT 23
|
5 | #define VREF1 22
|
6 | #define VREF2 19
|
7 |
|
8 | void Analog_Init()
|
9 | {
|
10 | ADCSRA|=(1<<ADIE)|(1<<ADEN);
|
11 | ADCSRA|= (1<<ADSC);
|
12 | }
|
13 |
|
14 | void setup()
|
15 | {
|
16 | Serial.begin(115200);
|
17 | analogReference(DEFAULT);
|
18 | pinMode(ST,OUTPUT);
|
19 | pinMode(1,OUTPUT);
|
20 | pinMode(VREF1,INPUT);
|
21 | pinMode(VREF2,INPUT);
|
22 | digitalWrite(1,HIGH);
|
23 | digitalWrite(ST,HIGH);
|
24 | }
|
25 |
|
26 | void loop()
|
27 | {
|
28 | digitalWrite(ST,HIGH);
|
29 | int x,y,z,VREF;
|
30 |
|
31 | x=analogRead(X_OUT);
|
32 | y=analogRead(Y_OUT);
|
33 | z=analogRead(Z_OUT);
|
34 | VREF=analogRead(VREF1);
|
35 | x=x-VREF;
|
36 | y=y-VREF;
|
37 |
|
38 | Serial.print(" X:");
|
39 | Serial.print(x);
|
40 | Serial.print(" Y:");
|
41 | Serial.print(y);
|
42 | Serial.print(" Z:");
|
43 | Serial.println(z);
|
44 | }
|
