#include <AccelStepper.h>
#include <Servo.h> //initiarize servomotor library 
Servo cncpen;
// Define the pins for your stepper motor
#define STEP_PIN 2
#define DIR_PIN 3
int val=0;// it is the valiable to store the servo degree possition
int led1=7;
int led2=6;
int led3=5;
int pb= 4;
AccelStepper stepper(1, STEP_PIN, DIR_PIN);

void setup() {
  cncpen.attach(10);
  pinMode(led1, OUTPUT);
   pinMode(led2, OUTPUT);
    pinMode(led3, OUTPUT);
    pinMode(pb, INPUT_PULLUP);
    // i Set the maximum speed and acceleration
  stepper.setMaxSpeed(1000);      // Adjust this value to change the speed
  stepper.setAcceleration(1000);   // Adjust this value to change the acceleration
  
  // Set the initial position (optional)
  stepper.setCurrentPosition(0);
  // put your setup code here, to run once:

}

void loop() {
  digitalWrite(led1, HIGH);
   // Move the stepper motor one revolution clockwise
  stepper.moveTo(200); // 200 steps is one full revolution for most common stepper motors
  stepper.runToPosition();// Pause for a moment
  delay(1000);// Move the stepper motor one revolution counterclockwise
  stepper.moveTo(-200); // Negative value for counterclockwise
  stepper.runToPosition();// Pause for a moment
  delay(1000);
  int pb = digitalRead(4);
  
  if(pb==LOW){
  digitalWrite(led2, HIGH);
  
  delay(100);
  digitalWrite(led3, LOW);
  delay(100);

for (val = 0; val <= 180; val += 1) { // goes from 0 degrees to 180 degrees
    // in steps of 1 degree
    cncpen.write(val);// tell servo to go to position in variable 'pos'
    delay(1000);// waits 15ms for the servo to reach the position
    digitalWrite(led3, HIGH);
  }
  for (val = 180; val>= 0; val -= 1) { // goes from 180 degrees to 0 degrees
    cncpen.write(val);// tell servo to go to position in variable 'pos'
    delay(1000);// waits 15ms for the servo to reach the position
    digitalWrite(led3, LOW);
  }

  }
  else
    digitalWrite(led2, LOW);
  
  
  
  }
  
  // put your main code here, to run repeatedly:
mega:SCL
mega:SDA
mega:AREF
mega:GND.1
mega:13
mega:12
mega:11
mega:10
mega:9
mega:8
mega:7
mega:6
mega:5
mega:4
mega:3
mega:2
mega:1
mega:0
mega:14
mega:15
mega:16
mega:17
mega:18
mega:19
mega:20
mega:21
mega:5V.1
mega:5V.2
mega:22
mega:23
mega:24
mega:25
mega:26
mega:27
mega:28
mega:29
mega:30
mega:31
mega:32
mega:33
mega:34
mega:35
mega:36
mega:37
mega:38
mega:39
mega:40
mega:41
mega:42
mega:43
mega:44
mega:45
mega:46
mega:47
mega:48
mega:49
mega:50
mega:51
mega:52
mega:53
mega:GND.4
mega:GND.5
mega:IOREF
mega:RESET
mega:3.3V
mega:5V
mega:GND.2
mega:GND.3
mega:VIN
mega:A0
mega:A1
mega:A2
mega:A3
mega:A4
mega:A5
mega:A6
mega:A7
mega:A8
mega:A9
mega:A10
mega:A11
mega:A12
mega:A13
mega:A14
mega:A15
led1:A
led1:C
led2:A
led2:C
led3:A
led3:C
btn1:1.l
btn1:2.l
btn1:1.r
btn1:2.r
stepper1:A-
stepper1:A+
stepper1:B+
stepper1:B-
A4988
drv1:ENABLE
drv1:MS1
drv1:MS2
drv1:MS3
drv1:RESET
drv1:SLEEP
drv1:STEP
drv1:DIR
drv1:GND.1
drv1:VDD
drv1:1B
drv1:1A
drv1:2A
drv1:2B
drv1:GND.2
drv1:VMOT
servo1:GND
servo1:V+
servo1:PWM
stepper2:A-
stepper2:A+
stepper2:B+
stepper2:B-
stepper3:A-
stepper3:A+
stepper3:B+
stepper3:B-
A4988
drv2:ENABLE
drv2:MS1
drv2:MS2
drv2:MS3
drv2:RESET
drv2:SLEEP
drv2:STEP
drv2:DIR
drv2:GND.1
drv2:VDD
drv2:1B
drv2:1A
drv2:2A
drv2:2B
drv2:GND.2
drv2:VMOT
A4988
drv3:ENABLE
drv3:MS1
drv3:MS2
drv3:MS3
drv3:RESET
drv3:SLEEP
drv3:STEP
drv3:DIR
drv3:GND.1
drv3:VDD
drv3:1B
drv3:1A
drv3:2A
drv3:2B
drv3:GND.2
drv3:VMOT
lcd1:VSS
lcd1:VDD
lcd1:V0
lcd1:RS
lcd1:RW
lcd1:E
lcd1:D0
lcd1:D1
lcd1:D2
lcd1:D3
lcd1:D4
lcd1:D5
lcd1:D6
lcd1:D7
lcd1:A
lcd1:K
keypad1:R1
keypad1:R2
keypad1:R3
keypad1:R4
keypad1:C1
keypad1:C2
keypad1:C3
keypad1:C4
btn2:1.l
btn2:2.l
btn2:1.r
btn2:2.r
btn3:1.l
btn3:2.l
btn3:1.r
btn3:2.r
ldr1:VCC
ldr1:GND
ldr1:DO
ldr1:AO
ldr2:VCC
ldr2:GND
ldr2:DO
ldr2:AO