Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <String.h>
- #include <Servo.h>
- Servo sv1;
- Servo sv2;
- String PTangle, kari;
- unsigned int ang;
- void setup() {
- Serial.begin(9600);
- pinMode(13, OUTPUT);
- digitalWrite(13, LOW);
- sv1.attach(9);
- sv2.attach(10);
- sv1.write(85);
- sv2.write(90);
- }
- void loop() {
- if (Serial.available() > 0) {
- PTangle = Serial.readStringUntil("\n");
- kari = PTangle.substring(1);
- ang = kari.toInt();
- if (ang >= 10 && ang <= 180) {
- if (PTangle.startsWith("p")) {
- ptang(sv1, ang);
- } else if (PTangle.startsWith("t")) {
- ptang(sv2, ang);
- }
- }
- }
- }
- void ptang(Servo x, int y) {
- digitalWrite(13, HIGH);
- x.write(y);
- delay(300);
- digitalWrite(13, LOW);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement