Advertisement
Guest User

Oded Oged Oded

a guest
Jun 24th, 2018
79
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.60 KB | None | 0 0
  1. #include <Arduino.h>
  2. #include "DRV8825.h"
  3.  
  4. #define MOTOR_STEPS 400
  5. #define RPM_X 240
  6. #define RPM_Y 240
  7. #define DIR_Y 7
  8. #define STEP_Y 4
  9. #define DIR_X 5
  10. #define STEP_X 2
  11. #define ENABLE 8
  12. #define MOTOR_ACCEL 2000
  13. #define MOTOR_DECEL 2000
  14. #define MODE0 11
  15. #define MODE01 9
  16. #define MODE1 12
  17. #define MODE2 13
  18.  
  19. DRV8825 stepperX(MOTOR_STEPS, DIR_X, STEP_X, ENABLE, MODE01, MODE1, MODE2);
  20. DRV8825 stepperY(MOTOR_STEPS, DIR_Y, STEP_Y, ENABLE, MODE0, MODE1, MODE2);
  21. char s=0;
  22. float x;
  23. float y;
  24. String X;
  25. String Y;
  26.  
  27. void setup() {
  28. Serial.begin(9600);
  29. Serial.println("Ready");
  30. stepperX.begin(RPM_X, 1);
  31. stepperX.enable();
  32. stepperY.begin(RPM_Y, 1);
  33. stepperY.enable();
  34. stepperX.setSpeedProfile(stepperX.LINEAR_SPEED, MOTOR_ACCEL, MOTOR_DECEL);
  35. stepperY.setSpeedProfile(stepperY.LINEAR_SPEED, MOTOR_ACCEL, MOTOR_DECEL);
  36. stepperX.setMicrostep(1);
  37. stepperY.setMicrostep(1);
  38. }
  39.  
  40. void loop()
  41. {
  42. if (s==0)
  43. {
  44. Serial.print("Enter X value: " );
  45. s++;
  46. }
  47. if (Serial.available()>0 && s == 1)
  48. {
  49. X = Serial.readString();
  50. x = X.toFloat();
  51. Serial.println(x);
  52. s++;
  53. }
  54. if (s==2)
  55. {
  56. Serial.print("Enter Y value: ");
  57. s++;
  58. }
  59. if (Serial.available()>0 && s == 3)
  60. {
  61. Y = Serial.readString();
  62. y = Y.toFloat();
  63. Serial.println(y);
  64. s++;
  65. }
  66. if (s==4)
  67. {
  68. //stepperX.rotate(x);
  69. stepperX.move((double)x);
  70. delay(10);
  71. // stepperY.rotate(y);
  72. stepperY.move((double)y);
  73. delay(10);
  74. s=0;
  75. x = 0;
  76. y = 0;
  77. X = "";
  78. Y = "";
  79. }
  80. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement