// MCU BASIC: https://www.basic4mcu.com
// DateTime : 2018-12-06 오후 11:14:12
// by Ok-Hyun Park
//
#include <CapacitiveSensor.h>
CapacitiveSensor  cs_4_8=CapacitiveSensor(4,8);
//
#include <AFMotor.h>
AF_Stepper motor(200,2);
//
void setup(){
  cs_4_8.set_CS_AutocaL_Millis(0xFFFFFFFF);
  pinMode(7,OUTPUT);
  Serial.begin(9600);
  Serial.println("Stepper Motor");
  motor.setSpeed(100);
}
//
int count=0,flag=0;
int motor_position=0,target_position=0;
//
void loop(){
  long sensor1=cs_4_8.capacitiveSensor(50);
  Serial.println(sensor1);
  if(sensor1>=10000)count=0; // 저항에 손대면
  //
  if(count>50){ // 5초 이상이면
    if(flag==0){ flag=1;
      digitalWrite(7,HIGH); target_position=1800;
    }
  }
  else{
    if(flag==0){
      digitalWrite(7,LOW); target_position=0;
    }
  } 
  //
  if(motor_position<target_position){ motor_position++; motor.step(1,FORWARD,DOUBLE); }
  if(motor_position>target_position){ motor_position--; motor.step(1,BACKWARD,DOUBLE); }
  //
  count++;
  delay(100);
}