#include <Arduino.h>

//int PWM_M1 = 10; oorspronkelijk
//int Dir_M1 = 12; oorspronkelijk

int ledjeVooruit = 6; // Motoren gaan naar voor
int ledjeAchteruit = 11; // Motoren gaan naar achter
int ledjeLinks = 10; // Motoren gaan naar links
int ledjeRechts = 9; // Motor motoren gaan naar rechts

int dkvooruit = 2; // drukknop 1 vooruit
int dkachteruit = 3; // drukknop 2 achteruit
int dklinks = 4; // drukknop 3 links
int dkrechts = 5; // drukknop 4 rechts

int readVooruitknop;
int readAchteruitknop;
int readLinksknop;
int readRechtsknop;

int duty_cycle = 0;
int speed = 0;

int PotPin = A0; // pin potentiometer
int PotVal = 0; // Waarde potentiometer
int outputValue = 0;

void setup()
{
  Serial.begin(9600);
	//pinMode(PWM_M1,OUTPUT); oorspronkelijk
	//pinMode(Dir_M1,OUTPUT); oorspronkelijk

  pinMode(ledjeVooruit,OUTPUT);
	pinMode(ledjeAchteruit,OUTPUT); 
  pinMode(ledjeLinks,OUTPUT);
	pinMode(ledjeRechts,OUTPUT);

  pinMode(dkvooruit,INPUT);
	pinMode(dkachteruit,INPUT);
  pinMode(dklinks,INPUT);
	pinMode(dkrechts,INPUT);
}

void loop() {
  PotVal = analogRead(PotPin); // potentiometer inlezen
  //PotVal = 255 - (PotVal * 3) / 4; // normalisatie op 255
  outputValue = map(PotVal, 0, 1023, 0, 255);

  readVooruitknop = digitalRead(dkvooruit);
  readAchteruitknop = digitalRead(dkachteruit);
  readLinksknop = digitalRead(dklinks);
  readRechtsknop = digitalRead(dkrechts);

  if(readVooruitknop == true)
  {
    analogWrite(ledjeVooruit, outputValue);
  }
  if(readAchteruitknop == true)
  {
    analogWrite(ledjeAchteruit, outputValue);
  }
  if(readLinksknop == true)
  {
    analogWrite(ledjeLinks, outputValue);
  }
  if(readRechtsknop == true)
  {
    analogWrite(ledjeRechts, outputValue);
  }
  if(readVooruitknop == false && readAchteruitknop == false && readLinksknop == false && readRechtsknop == false)
  {
    digitalWrite(ledjeVooruit, LOW);
    digitalWrite(ledjeAchteruit, LOW);
    digitalWrite(ledjeLinks, LOW);
    digitalWrite(ledjeRechts, LOW);
  }
}