#include <AccelStepper.h>
#define Enable (1) // Enable motor control
#define Pin_step_B1 (2) // Pin steping back left motor
#define Pin_dir_B1 (3)
#define FORWARD_MODE (2)
#define BACKWARD_MODE (7)
AccelStepper FL(Enable,Pin_step_B1, Pin_dir_B1); // pin 3 = step, pin 6 = direction
int Incoming_value = 0 ;
void setup()
{
Serial.begin(9600);
FL.setMaxSpeed(2000);
}
void loop()
{
if (Serial.available()> 0)
{
Incoming_value = Serial.read();
Serial.print(Incoming_value);
Serial.print("\n");
if(Incoming_value == '1')
{
FORWARD_MODE();
}
if(Incoming_value == '0')
{
BACKWARD_MODE();
}
}
void FORWARD_MODE() // กด 2 เดินหน้า
{
FL.setSpeed(100);
FL.runSpeed();
}
void BACKWARD_MODE() // กด 7 ถอยหลัง
{
FL.setSpeed(-100);
FL.runSpeed();
}
/*val = Serial.read();
Serial.println(val);*/