Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <A4988.h>
- #include <BasicStepperDriver.h>
- #include <DRV8825.h>
- #include <DRV8834.h>
- #include <DRV8880.h>
- #include <MultiDriver.h>
- #include <SyncDriver.h>
- BasicStepperDriver stepper(200, 8, 9, 10);
- BasicStepperDriver mtr(200, 5, 6, 7);
- void setup() {
- // put your setup code here, to run once:
- stepper.begin(120, 1);
- mtr.begin(60, 1);
- }
- void loop() {
- // put your main code here, to run repeatedly:
- rodar(3, 120, 2, 0);
- rodar(7, 100, 3, 0);
- rodar(3, 154, 2, 1);
- rodar(6.2, 120, 3, 1);
- rodar(9, 142, 2, 1);
- rodar(4, 170, 3, 0);
- //tentativa(7, 60, 200, 1);
- //tentativa(7, 170, 120, 1);
- }
- void rodar(float v, int vel, int m, bool s) {
- if (m == 2) {
- if (s == true) {
- for (int i = 0; i < (40 * v) ; i++) {
- mtr.enable();
- mtr.setRPM(vel);
- mtr.move(5);
- delayMicroseconds(10);
- }
- mtr.disable();
- }
- else {
- for (int i = 0; i < (40 * v) ; i++) {
- mtr.enable();
- mtr.setRPM(vel);
- mtr.move(-5);
- delayMicroseconds(10);
- }
- mtr.disable();
- }
- }
- if (m == 3) {
- if (s = true) {
- for (int i = 0; i < (40 * v) ; i++) {
- stepper.enable();
- stepper.setRPM(vel);
- stepper.move(5);
- delayMicroseconds(10);
- }
- stepper.disable();
- }
- else {
- for (int i = 0; i < (40 * v) ; i++) {
- stepper.enable();
- stepper.setRPM(vel);
- stepper.move(-5);
- delayMicroseconds(10);
- }
- stepper.disable();
- }
- }
- }
- void tentativa(float v, int vel1, int vel2, bool s) {
- for (int i = 0; i < (40 * v) ; i++) {
- stepper.setRPM(vel1);
- stepper.move(5);
- delayMicroseconds(10);
- mtr.setRPM(vel2);
- mtr.move(5);
- delayMicroseconds(10);
- }
- stepper.disable();
- mtr.disable();
- }
Add Comment
Please, Sign In to add comment