Adapting Sprinter for new electronics January 27, 2014 11:42AM |
Registered: 11 years ago Posts: 9 |
Re: Adapting Sprinter for new electronics January 30, 2014 02:28PM |
Registered: 10 years ago Posts: 19 |
void Stepper::stepMotor(int thisStep) { if (this->pin_count == 2) { switch (thisStep) { case 0: /* 01 */ digitalWrite(motor_pin_1, LOW); digitalWrite(motor_pin_2, HIGH); break; case 1: /* 11 */ digitalWrite(motor_pin_1, HIGH); digitalWrite(motor_pin_2, HIGH); break; case 2: /* 10 */ digitalWrite(motor_pin_1, HIGH); digitalWrite(motor_pin_2, LOW); break; case 3: /* 00 */ digitalWrite(motor_pin_1, LOW); digitalWrite(motor_pin_2, LOW); break; } } if (this->pin_count == 4) { switch (thisStep) { case 0: // 1010 digitalWrite(motor_pin_1, HIGH); digitalWrite(motor_pin_2, LOW); digitalWrite(motor_pin_3, HIGH); digitalWrite(motor_pin_4, LOW); break; case 1: // 0110 digitalWrite(motor_pin_1, LOW); digitalWrite(motor_pin_2, HIGH); digitalWrite(motor_pin_3, HIGH); digitalWrite(motor_pin_4, LOW); break; case 2: //0101 digitalWrite(motor_pin_1, LOW); digitalWrite(motor_pin_2, HIGH); digitalWrite(motor_pin_3, LOW); digitalWrite(motor_pin_4, HIGH); break; case 3: //1001 digitalWrite(motor_pin_1, HIGH); digitalWrite(motor_pin_2, LOW); digitalWrite(motor_pin_3, LOW); digitalWrite(motor_pin_4, HIGH); break; } } }
void Stepper::stepMotor(int thisStep) { if (this->pin_count == 2) { switch (thisStep) { case 0: /* 01 */ digitalWrite(motor_pin_1, LOW); digitalWrite(motor_pin_2, HIGH); break; case 1: /* 11 */ digitalWrite(motor_pin_1, HIGH); digitalWrite(motor_pin_2, HIGH); break; case 2: /* 10 */ digitalWrite(motor_pin_1, HIGH); digitalWrite(motor_pin_2, LOW); break; case 3: /* 00 */ digitalWrite(motor_pin_1, LOW); digitalWrite(motor_pin_2, LOW); break; } } if (this->pin_count == 4) { switch (thisStep) { case 0: // 1000 digitalWrite(motor_pin_1, HIGH); digitalWrite(motor_pin_2, LOW); digitalWrite(motor_pin_3, LOW); digitalWrite(motor_pin_4, LOW); break; case 1: // 0100 digitalWrite(motor_pin_1, LOW); digitalWrite(motor_pin_2, HIGH); digitalWrite(motor_pin_3, LOW); digitalWrite(motor_pin_4, LOW); break; case 2: //0010 digitalWrite(motor_pin_1, LOW); digitalWrite(motor_pin_2, LOW); digitalWrite(motor_pin_3, HIGH); digitalWrite(motor_pin_4, LOW); break; case 3: //0001 digitalWrite(motor_pin_1, LOW); digitalWrite(motor_pin_2, LOW); digitalWrite(motor_pin_3, LOW); digitalWrite(motor_pin_4, HIGH); break; } } }
Re: Adapting Sprinter for new electronics January 31, 2014 02:46PM |
Registered: 11 years ago Posts: 9 |
#include int nbPas = 200; int trMin = 30; int pas = 200; // Moteur X int XEN = 45; // X-EN int AX = 47; // AX int BX = 44; // BX int CX = 50; // CX : modif : 40=41 (sans doute faux contact) int DX = 39; // DX Stepper MX (nbPas, AX, BX, CX, DX); int xmin=14; int etatX=0; // Motor Y int YEN = 43; // Y-EN int AY = 42; // AY int BY = 41; // BY int CY = 38; // CY int DY = 37; // DY Stepper MY(nbPas, AY, BY, CY, DY); int ymin=16; int etatY=0; // Motor Z int ZEN = 49; // Z-EN int AZ = 48; // AZ int BZ = 46; // BZ int CZ = 36; // CZ int DZ = 35; // DZ Stepper MZ(nbPas, AZ, BZ, CZ, DZ); int zmin=18; int etatZ=0; // Motor E0 int E0EN = 31; // E0-EN int AE0 = 33; // AE0 int BE0 = 34; // BE0 int CE0 = 30; // CE0 int DE0 = 32; // DE0 Stepper ME0(nbPas, AE0, BE0, CE0, DE0); // Motor E1 int E1EN = 26; // E1-EN int AE1 = 28; // AE1 int BE1 = 29; // BE1 int CE1 = 25; // CE1 int DE1 = 27; // DE1 Stepper ME1(nbPas, AE1, BE1, CE1, DE1); //Alim int led=13; void setup() { pinMode(XEN, OUTPUT); pinMode(xmin, INPUT); MX.setSpeed(trMin); pinMode(YEN, OUTPUT); pinMode(ymin,INPUT); MY.setSpeed(trMin); pinMode(ZEN, OUTPUT); pinMode(zmin,INPUT); MZ.setSpeed(trMin); pinMode(E0EN, OUTPUT); ME0.setSpeed(trMin); pinMode(E1EN, OUTPUT); ME1.setSpeed(trMin); pinMode(led, OUTPUT); Serial.begin(9600); } void loop() { digitalWrite(led,HIGH); digitalWrite(XEN, HIGH); etatX=digitalRead(xmin); while(etatX!=1) { MX.step(-1); etatX=digitalRead(xmin); } MX.step(pas); digitalWrite(YEN, HIGH); etatY=digitalRead(ymin); while(etatY!=1) { MY.step(-1); etatY=digitalRead(ymin); } MY.step(pas); digitalWrite(ZEN, HIGH); MZ.step(-50); digitalWrite(E0EN, HIGH); ME0.step(100); digitalWrite(E1EN, HIGH); ME1.step(100); }
Re: Adapting Sprinter for new electronics February 04, 2014 02:06PM |
Registered: 10 years ago Posts: 19 |
Re: Adapting Sprinter for new electronics February 05, 2014 04:53AM |
Registered: 11 years ago Posts: 9 |