קורס RB10 , רובטיקס בלוקס : תרגול 005 –הפעלת לד ומנוע סרבו ופוטנציומטר בשפת C
|
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 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 |
// Servo Sweep example for the ESP32 #include <ESP32Servo.h> int servoPin = 25; int ledRed = 33; int ledGreen = 32; int analogPin = 26; int val=0; Servo servo; void setup() { Serial.begin(115200); Serial.println("Start"); servo.attach(servoPin, 500, 2400); pinMode(ledRed ,OUTPUT); pinMode(ledGreen ,OUTPUT); } int pos = 0; void loop() { // debug value for (pos = 0; pos <= 180; pos += 2) { servo.write(pos); digitalWrite(ledRed,HIGH); val = analogRead(analogPin); // read the input pin Serial.println(val/50); delay(val/100); // speed digitalWrite(ledGreen,LOW); } for (pos = 180; pos >= 0; pos -= 2) { servo.write(pos); digitalWrite(ledRed,LOW); val = analogRead(analogPin); // read the input pin Serial.println(val/50); delay(val/100); // speed digitalWrite(ledGreen,HIGH); } } |
