kennyho-rass

l293 shield stepper 2x 24byj48 serialmonitor remote number

Nov 7th, 2019
333
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. #include <AFMotor.h>
  2.  
  3. AF_Stepper motor1(48, 1);
  4. AF_Stepper motor2(48, 2);
  5.  
  6. char cmdCode = '0';
  7. int cmdValue = 0;
  8. #define serial Serial
  9. void setup() {
  10.   Serial.begin(9600);           // set up Serial library at 9600 bps
  11.   motor1.setSpeed(250);  // 30 rpm
  12.   motor2.setSpeed(250);  // 30 rpm
  13. }
  14. void processEvents() {
  15. }
  16. void loop()
  17. {
  18.   processEvents();
  19.   //Receives commands from android device:
  20.   {
  21.     int inByte = serial.read();
  22.     serial.println((char)inByte);
  23.     switch ((char)inByte)
  24.     {
  25.       case '8':
  26.         for (int i = 0; i < 20; i++)
  27.         { int inByte = serial.read();
  28.           if ((char)inByte == 's')
  29.           { motor1.release();
  30.             motor2.release();
  31.             break;
  32.           }
  33.           else
  34.           {
  35.             motor1.step(10, FORWARD, DOUBLE);
  36.             motor2.step(10, FORWARD, DOUBLE);
  37.           }
  38.         }
  39.         break;
  40.  
  41.          case '2':
  42.         for (int i = 0; i < 20; i++)
  43.         { int inByte = serial.read();
  44.           if ((char)inByte == 's')
  45.           { motor1.release();
  46.             motor2.release();
  47.             break;
  48.           }
  49.           else
  50.           {
  51.             motor1.step(10, BACKWARD, DOUBLE);
  52.             motor2.step(10, BACKWARD, DOUBLE);
  53.           }
  54.         }
  55.         break;
  56.    
  57.      case '4':
  58.         for (int i = 0; i < 20; i++)
  59.         { int inByte = serial.read();
  60.           if ((char)inByte == 's')
  61.           { motor1.release();
  62.             motor2.release();
  63.             break;
  64.           }
  65.           else
  66.           {
  67.             motor1.step(1, FORWARD, DOUBLE);
  68.             motor2.step(1, BACKWARD, DOUBLE);
  69.           }
  70.         }
  71.         break;
  72.    
  73.      case '6':
  74.         for (int i = 0; i < 20; i++)
  75.         { int inByte = serial.read();
  76.           if ((char)inByte == 's')
  77.           { motor1.release();
  78.             motor2.release();
  79.             break;
  80.           }
  81.           else
  82.           {
  83.             motor1.step(1, BACKWARD, DOUBLE);
  84.             motor2.step(1, FORWARD, DOUBLE);
  85.           }
  86.         }
  87.         break;
  88.  
  89.        
  90.      case '5':
  91.         for (int i = 0; i < 20; i++)
  92.         { int inByte = serial.read();
  93.           if ((char)inByte == 's')
  94.           { motor1.release();
  95.             motor2.release();
  96.             break;
  97.           }
  98.           else
  99.           {
  100.             motor1.step(0, FORWARD, DOUBLE);
  101.             motor2.step(0, FORWARD, DOUBLE);
  102.           }
  103.         }
  104.         break;
  105.    
  106.    
  107.    
  108.    
  109.     }
  110.   }
  111. }
Advertisement
Add Comment
Please, Sign In to add comment