Stap 5: Stap 4: de Motor Code
Op de motor code, ik 1 motor aan de code toegevoegd zodat het 2 motoren tegelijk draaien kan. Als u wilt om zich te ontdoen van deze, nemen alles wat int pinI3 zegt = 12; int pinI4 = 13;
int speedpinB = 10; pinMode(pinI3,OUTPUT); pinMode(pinI4,OUTPUT); pinMode(speedpinB,OUTPUT);
en digitalWrite(pinI4,LOW); digitalWrite(pinI3,HIGH);
Motor Code:
#include "MotorDriver.h"const int POT_PIN = A0; const int POT_PIN2 = A1; int motorSpeed = 0; int potVal = 0; int pinI1=8;//define I1 interface int pinI2=11;//define I2 interface int pinI3=12; int pinI4=13; int speedpinA=9;//enable motor A int speedpinB=10;void setup() { Serial.begin(9600); TCCR1B = TCCR1B & 0b11111000 | 0x01; pinMode(pinI1,OUTPUT); pinMode(pinI2,OUTPUT); pinMode(pinI3,OUTPUT); pinMode(pinI4,OUTPUT); pinMode(speedpinA,OUTPUT); pinMode(speedpinB,OUTPUT);}void loop() { potVal = analogRead(POT_PIN); potVal = analogRead(POT_PIN2);motorSpeed = map(potVal, 0, 1023, 0, 255);Serial.print(potVal); Serial.print(motorSpeed); Serial.println();analogWrite(speedpinA, motorSpeed); analogWrite(speedpinB, motorSpeed); digitalWrite(pinI2,LOW);//turn DC Motor A move anticlockwise digitalWrite(pinI1,HIGH); digitalWrite(pinI4,LOW); digitalWrite(pinI3,HIGH);}