// Listing 7.7. Mechanizm t?umacz?cy PUMT  testowanie sterowania pr?dko?ci? obrotow? dw?ch serwomotor?w


/*Rama projektowa Softbot
Nazwa: ServoMotor
Cz??ci:
Sekcja silnik?w:
Dwa serwomotory bezszczotkowe wykonuj?ce obroty w spos?b ciag?y

    
Akcje:
Krok 1.: Inicjalizuj silniki.
Krok 2.: Obracaj wa?em serwomotor?w od zatrzymania do pr?dko?ci maksymalnej (od 90 do 180)  pr?dko?? zwi?kszaj stopniowo o warto?? r?wn? 5.
Krok 3.: Obracaj wa?em serwomotor?w od pr?dko?ci maksymalnej do zatrzymania (od 180 do 90)  pr?dko?? zmniejszaj stopniowo o warto?? r?wn? 5.
     
Zadania:
Sprawd? dzia?anie serwomotor?w, steruj?c pr?dkosci? obrotow? ich wa??w.
Koniec ramy*/

1    #include <Servo.h>
2    
3    Servo LeftServo; 
4    Servo RightServo;  
5    
6    int Angle = 0;     
7    
8    void setup() 
9    {
10        LeftServo.attach(9);
11        RightServo.attach(10); 
12    }
13    
14    void loop() 
15    {
16        for(Angle = 90; Angle < 180; Angle += 5)
17        {
18            LeftServo.write(Angle); 
19            RightServo.write(Angle);                  
20            delay(25);                           
21        }
22       
23        for(Angle = 180; Angle >= 90; Angle += 5)
24        {
25            LeftServo.write(Angle); 
26            RightServo.write(Angle);                  
27            delay(25);                           
28        } 
29    }

