Grove enda axel analoga Gyro (3 / 3 steg)
Steg 3: kod
Efter att få ansluten hårdvaran nu dags att ladda upp programmet, Känn dig fri att ändra koden och gör den lämplig för ditt projekt.
Alla som koden gör är läser det analoga värdet och gör några matematik och skrivs det ut på en seriell övervaka. Bearbetade data kan användas för att göra en orienteringssensor som jag ska Visa snart.
< p > int sensorPin = A0; Välj input PIN-koden för sensorn < br >
flyta reference_Value = 0; < /p >< p > int sensorValue = 0; variabel för att lagra värdet kommer från sensorn < /p >< p > void setup() {< /p >< p > int i;
float summan = 0;
pinMode (sensorPin, ingång);
Serial.BEGIN(9600);
Serial.println ("du kan inte rotera det innan kalibrera!");
Serial.println ("få referensvärdet:");
för (jag = 0; jag < 1000; i ++)
{
Läs värdet från sensorn:
sensorValue = analogRead(sensorPin);
summa += sensorValue;
Delay(5);
}
reference_Value = summa/1000.0;
Serial.println(reference_Value);
Serial.println ("nu kan du börja din test!");
} < /p >< p > void loop()
{< /p >< p > dubbla angularVelocity;
sensorValue = analogRead(sensorPin);
angularVelocity =((double)(sensorValue-reference_Value) * 4930.0) /1023.0/0.67; få de vinkelformig hastigheten
Serial.Print(angularVelocity);
Serial.println("deg/s");
Serial.println("");
Delay(10);
} < /p >