#include "lopigaengsel.h"
lopigaengsel bahuKiri(8);
lopigaengsel sikuKiri(8);
lopigaengsel bahuKanan(8);
lopigaengsel sikuKanan(8);
lopigaengsel tes(8);

byte btn_memper, btn_sikapsiap;
bool status, statusSiap;

void setup() {
  Serial.begin(9600);
  pinMode(A0, INPUT_PULLUP);
  pinMode(A1, INPUT_PULLUP);
  bahuKanan.pin(5);
  sikuKanan.pin(6);
  bahuKiri.pin(9);
  sikuKiri.pin(10);

}
void loop() {
  btn_memper = digitalRead(A0);
  btn_sikapsiap = digitalRead(A1);

  if (btn_memper == LOW) {
    status = true;
    statusSiap = false;
  }
  if (btn_sikapsiap == LOW) {
    status = false;
    statusSiap = true;
  }
  if (status == 1) {
    bahuKiri.Servo5(150);
    sikuKiri.Servo2(120);
    bahuKanan.Servo3(140);
    sikuKanan.Servo10(130);
  }
  if (statusSiap == 1) {
    bahuKiri.Servo5(30);
    sikuKiri.Servo2(20);
    bahuKanan.Servo3(10);
    sikuKanan.Servo10(40);
  }
}