Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Servo.h>
- #define CLK 9
- #define DT 8
- #define SW 7
- int ROTPOS = 0;
- int CURRENT = 0;
- int BEFORE = 0;
- int LR = 0;
- int LEFT = 1;
- int RIGHT = -1;
- Servo myservo;
- void setup() {
- Serial.begin(9600);
- pinMode(CLK,INPUT);
- pinMode(DT,INPUT);
- pinMode(SW,INPUT);
- BEFORE = digitalRead(CLK);
- myservo.attach(13);
- }
- void loop() {
- CURRENT = digitalRead(CLK);
- if(CURRENT != BEFORE){
- if(digitalRead(DT) != CURRENT){
- if(ROTPOS<180 && ROTPOS >=0)ROTPOS++;
- LR = LEFT;
- }
- else{
- if(ROTPOS<=180 && ROTPOS >0)ROTPOS--;
- LR = RIGHT;
- }
- if(LR == LEFT){
- Serial.print("RIGHT ");
- }
- if(LR == RIGHT){
- Serial.print("LEFT ");
- }
- myservo.write(ROTPOS);
- delay(15);
- Serial.println(ROTPOS);
- }
- if(digitalRead(SW) == LOW){
- Serial.println("klik");
- }
- BEFORE = CURRENT;
- delay(100);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement