Advertisement
Guest User

P-Regler

a guest
Dec 12th, 2019
132
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 1.07 KB | None | 0 0
  1. #define motorl    9 //Motor Links Vorwärts
  2. #define motorr    3 //Motor Rechts Vorwärts
  3. #define motorlr   6 //Motor links Rückwärts
  4. #define motorrr   5 //Motor Rechts Rückwärts
  5. #define sensorl  A2 //Sensorwert
  6. #define sensorr  A1 //Sensorwert
  7.  
  8. void setup() {
  9.   // put your setup code here, to run once:
  10.   pinMode(motorl, OUTPUT);
  11.   pinMode(motorr, OUTPUT);
  12.   pinMode(motorlr, OUTPUT);
  13.   pinMode(motorrr, OUTPUT);
  14.   pinMode(sensorl, INPUT);
  15.   pinMode(sensorr, INPUT);
  16. }
  17.  
  18. void loop() {
  19.   int helligkeitl = analogRead(sensorl);
  20.   int helligkeitr = analogRead(sensorr);
  21.   int abweichung = abs(helligkeitl - helligkeitr);
  22.   int abweichung = val = map(abweichung, 0, 1023, 0, 127);
  23.   int Richtung = helligkeitl > helligkeitr;
  24.  
  25.   if (Richtung) {
  26.     analogWrite(motorl, 127 + abweichung);
  27.     analogWrite(motorr, 127);
  28.     analogWrite(motorlr, 127);
  29.     analogWrite(motorrr, 127 + abweichung);
  30.   } else {
  31.     analogWrite(motorl, 127);
  32.     analogWrite(motorr, 127 + abweichung);
  33.     analogWrite(motorlr, 127 + abweichung);
  34.     analogWrite(motorrr, 127);
  35.   }
  36. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement