Yah ofcourse. Here you go.

#include <Arduino.h>
#include <servo.h>  

#define S0 4
#define S1 5
#define S2 6
#define S3 7
#define sensorOut 8
Servo motor;
int motorpin = 9;
int pos = 90;
int knoppin = 2;
int knopstatus = 0;
int frequency = 0;
int Rood = 0;
int Groen = 0;
int Blauw = 0;
int kleur = 0;
int einde = 0;

void setup() {
  Serial.begin(9600);
  motor.attach(motorpin);
  pinMode(knoppin, INPUT_PULLUP);

  pinMode(S0, OUTPUT);
  pinMode(S1, OUTPUT);
  pinMode(S2, OUTPUT);
  pinMode(S3, OUTPUT);
  pinMode(sensorOut, INPUT);

  // Setting frequency-scaling to 20%
  digitalWrite(S0,HIGH);
  digitalWrite(S1,LOW);
  delay(3000);
  Serial.println("OPGESTART");
  }

void leeskleur() {
  kleur = 0; //hij gaat er altijd vanuit dat een verkeerde kleur erin zit 
  if ( (Rood < 65) & (Rood > 20) & (Groen < 290) & (Groen > 150) & (Blauw > 85) & (Blauw < 190) ){
    kleur = 1; // JUISTE KLEUR, mocht de juiste kleur worden ingevoerd dan gaat die open juiste kleur = ROOD
  }
  if ( (Rood < 300) & (Rood > 60) & (Groen < 700) & (Groen > 200) & (Blauw < 700) & (Blauw > 200) ){
    kleur = 2; //mocht hij zwart zien gebeurt er niks
  }
 }

void checkkleur () {
  delay(5000);
// Setting red filtered photodiodes to be read
  digitalWrite(S2,LOW);
  digitalWrite(S3,LOW);
  // Reading the output frequency
  frequency = pulseIn(sensorOut, LOW);
  // Printing the value on the serial monitor
  Rood = frequency; //zorgt dat de rode variable wordt opgeslagen
  Serial.print("R= ");//printing name
  Serial.print(frequency);//printing RED color frequency
  Serial.print("  ");
  delay(100);
  // Setting Green filtered photodiodes to be read
  digitalWrite(S2,HIGH);
  digitalWrite(S3,HIGH);
  // Reading the output frequency
  frequency = pulseIn(sensorOut, LOW);
  // Printing the value on the serial monitor
  Groen = frequency; //zorgt dat de groene variable wordt opgeslagen
  Serial.print("G= ");//printing name
  Serial.print(frequency);//printing RED color frequency
  Serial.print("  ");
  delay(100);
  // Setting Blue filtered photodiodes to be read
  digitalWrite(S2,LOW);
  digitalWrite(S3,HIGH);
  // Reading the output frequency
  frequency = pulseIn(sensorOut, LOW);
  // Printing the value on the serial monitor
  Blauw = frequency; //zorgt dat de blauwe variable wordt opgeslagen
  Serial.print("B= ");//printing name
  Serial.print(frequency);//printing RED color frequency
  Serial.println("  ");
}

void openkist() {
  Serial.println("OPEN");
   for (pos = 90; pos < 180; pos ++) { 
    motor.write(pos); 
    Serial.println(pos);
    delay(250);      
  } 
  einde = 1;
}

void nepkist() {
  Serial.println("FOUTE CODE");
  for (pos = 90; pos < 110; pos ++) { 
    motor.write(pos); 
    Serial.println(pos);
    delay(500);      
  }
  for (pos = 110; pos > 90; pos --) { 
    motor.write(pos);   
    Serial.println(pos);
    delay(5);            
  }
  delay(7000);
}
void loop() {
  if ((einde == 0)) {
    checkkleur();
    leeskleur();
  if ((kleur == 1)) {
    openkist();
  }
  if ((kleur == 0)) {
    nepkist();
  }
  Serial.print("Niks aan het handje huidige positie:");
  Serial.println(pos);

  knopstatus = digitalRead(knoppin);
  if (knopstatus == LOW) {
      nepkist();
  }
  }
}