Scribd
Upload
7 views

Codegohome

Uploaded by

danghieu77810206
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as DOCX, PDF, TXT or read online on Scribd
7 views

Codegohome

Uploaded by

danghieu77810206
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as DOCX, PDF, TXT or read online on Scribd
You are on page 1/ 2

#include <Arduino.

h>
#include <AccelStepper.h>

int step_X = 54; int Dir_X = 55; int ena_X = 38;


int step_Y = 60; int Dir_Y = 61; int ena_Y = 56;
int step_Z = 46; int Dir_Z = 48; int ena_Z = 62;

AccelStepper Step_X(1, step_X, Dir_X, ena_X);


AccelStepper Step_Y(1, step_Y, Dir_Y, ena_Y);
AccelStepper Step_Z(1, step_Z, Dir_Z, ena_Z);

#define end_X 3
#define end_Y 14
#define end_Z 18

void home_YZ()
{
int homeY = 0; int homeZ = 0;

Step_Y.setMaxSpeed(100);
Step_Y.setAcceleration(100);
Step_Z.setMaxSpeed(100);
Step_Z.setAcceleration(100);
Step_Y.enableOutputs();
Step_Z.enableOutputs();

while(digitalRead(end_Y)==1 and digitalRead(end_Z)==1)


{
Step_Y.moveTo(homeY);
Step_Z.moveTo(homeZ);
homeY ++;
homeZ --;
Step_Y.run();
Step_Z.run();
}

while(digitalRead(end_Y)==1)
{
Step_Y.moveTo(homeY);
homeY ++;
Step_Y.run();
}
Step_Y.setCurrentPosition(0);

while(digitalRead(end_Z)==1)
{
Step_Z.moveTo(homeZ);
homeZ --;
Step_Z.run();
}
Step_Z.setCurrentPosition(0);

homeY = 0; homeZ = 0;
}

void home_X()
{
int homeX = 0;
Step_X.setMaxSpeed(100);
Step_X.setAcceleration(100);
Step_X.enableOutputs();

while(digitalRead(end_X)==1)
{
Step_X.moveTo(homeX);
homeX ++;
Step_X.run();
}
Step_X.setCurrentPosition(0);

homeX = 0;
}

void setup()
{
pinMode(end_X, INPUT_PULLUP);
pinMode(end_Y, INPUT_PULLUP);
pinMode(end_Z, INPUT_PULLUP);

Step_X.setEnablePin(38);
Step_X.setPinsInverted(false, false, true);
Step_Y.setEnablePin(56);
Step_Y.setPinsInverted(false, false, true);
Step_Z.setEnablePin(62);
Step_Z.setPinsInverted(false, false, true);

home_YZ();
home_X();
}

void loop()
{

You might also like