Arduino

ray

1. #include<SoftwareSerial.h>
   
2. SoftwareSerial BT(8,9);
   
3. const int xpin = A0;
   
4. const int ypin = A1;
   
5. const int zpin = A2;
   
6. const int pin = 4;
   
7. void setup() {
   
8.   // put your setup code here, to run once:
   
9.   Serial.begin(9600);
   
10.   pinMode(xpin,INPUT);
    
11.   pinMode(ypin,INPUT);
    
12.   pinMode(zpin,INPUT);
    
13.   pinMode(pin,OUTPUT);
    
14.   BT.begin(38400);
    
15. }
    
16. 
    
17. void loop() {
    
18.   // put your main code here, to run repeatedly:
    
19.   int x = analogRead(xpin);
    
20.   x=((float)x-331.5)/65*9.8;
    
21.   Serial.print("x=");
    
22.   Serial.println(x);
    
23.   int y = analogRead(ypin);
    
24.   y=((float)y-331.5)/65*9.8;
    
25.   Serial.print("y=");
    
26.   Serial.println(y);
    
27.   int z = analogRead(zpin);
    
28.   z=((float)z-331.5)/65*9.8;
    
29.   Serial.print("z=");
    
30.   Serial.println(z);
    
31.   if(x > 5)
    
32.   {
    
33.     digitalWrite(pin,1);
    
34.     BT.available();
    
35.     BT.write("1");
    
36.   }
    
37.   else
    
38.   {
    
39.     digitalWrite(pin,0);
    
40.     BT.available();
    
41.     BT.write("0");
    
42.   }
    
43.   delay(100);
    
44. }

複製代碼