Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <AFMotor.h>
- AF_Stepper motor1(48, 1);
- AF_Stepper motor2(48, 2);
- char cmdCode = '0';
- int cmdValue = 0;
- #define serial Serial
- void setup() {
- Serial.begin(9600); // set up Serial library at 9600 bps
- motor1.setSpeed(250); // 30 rpm
- motor2.setSpeed(250); // 30 rpm
- }
- void processEvents() {
- }
- void loop()
- {
- processEvents();
- //Receives commands from android device:
- {
- int inByte = serial.read();
- serial.println((char)inByte);
- switch ((char)inByte)
- {
- case '8':
- for (int i = 0; i < 20; i++)
- { int inByte = serial.read();
- if ((char)inByte == 's')
- { motor1.release();
- motor2.release();
- break;
- }
- else
- {
- motor1.step(10, FORWARD, DOUBLE);
- motor2.step(10, FORWARD, DOUBLE);
- }
- }
- break;
- case '2':
- for (int i = 0; i < 20; i++)
- { int inByte = serial.read();
- if ((char)inByte == 's')
- { motor1.release();
- motor2.release();
- break;
- }
- else
- {
- motor1.step(10, BACKWARD, DOUBLE);
- motor2.step(10, BACKWARD, DOUBLE);
- }
- }
- break;
- case '4':
- for (int i = 0; i < 20; i++)
- { int inByte = serial.read();
- if ((char)inByte == 's')
- { motor1.release();
- motor2.release();
- break;
- }
- else
- {
- motor1.step(1, FORWARD, DOUBLE);
- motor2.step(1, BACKWARD, DOUBLE);
- }
- }
- break;
- case '6':
- for (int i = 0; i < 20; i++)
- { int inByte = serial.read();
- if ((char)inByte == 's')
- { motor1.release();
- motor2.release();
- break;
- }
- else
- {
- motor1.step(1, BACKWARD, DOUBLE);
- motor2.step(1, FORWARD, DOUBLE);
- }
- }
- break;
- case '5':
- for (int i = 0; i < 20; i++)
- { int inByte = serial.read();
- if ((char)inByte == 's')
- { motor1.release();
- motor2.release();
- break;
- }
- else
- {
- motor1.step(0, FORWARD, DOUBLE);
- motor2.step(0, FORWARD, DOUBLE);
- }
- }
- break;
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment