Arduino Notebook v1-1

/*
Arduino 3D Wire Bending Machine

by Dejan Nedelkovski
www.HowToMechatronics.com
Library - AccelStepper by Mike McCauley:
http://www.airspayce.com/mikem/arduino/AccelStepper/index.html
*/
#include <AccelStepper.h>
#include <Servo.h>
#define limitSwitch 11
// Define the stepper motors and the pins the will use
AccelStepper feederStepper(1, 5, 6); // (Type:driver, STEP, DIR)
AccelStepper zAxisStepper(1, 7, 8);
AccelStepper benderStepper(1, 9, 10);
Servo servo01;
String dataIn = "";
String manualStatus = "";
int count = 0;
int dist;
void setup() {
Serial.begin(9600);
pinMode(limitSwitch, INPUT_PULLUP);
servo01.attach(2);
servo01.write(40); // Initial position, bending pin up
// Stepper motors max speed
feederStepper.setMaxSpeed(2000);
zAxisStepper.setMaxSpeed(2000);
benderStepper.setMaxSpeed(2000);
// Homing
while (digitalRead(limitSwitch) != 0) {
benderStepper.setSpeed(1200);
benderStepper.runSpeed();
benderStepper.setCurrentPosition(0); // When limit switch pressed set position
to 0 steps
}
delay(40);
// Move 1400 steps from the limit switch to starting position
while (benderStepper.currentPosition() != -1400) {
benderStepper.setSpeed(-1200); // if negative rotates anti-clockwise
benderStepper.run();
}
benderStepper.setCurrentPosition(0);
}
void loop() {
String mode = Serial.readString();
if (mode.startsWith("manual")) {
manual();
}
if (mode.startsWith("star")) {
star();
}
if (mode.startsWith("cube")) {
cube();
}
if (mode.startsWith("stand")) {
stand();
}
}
void star() {
while (count != 5) {
int feed = 38; // mm
int feedDistance = feed * 48; // 48- constats that map the mm value to number
of steps the stepper show move
while (feederStepper.currentPosition() != feedDistance) { // run until it
reaches the distance value
feederStepper.setSpeed(1200);
feederStepper.run();
}
feederStepper.setCurrentPosition(0); // reset the current position to 0
servo01.write(40); // Set the bender pin up
delay(200);
int angleConst = 18; // angle constant
// Bend the wire 52 degrees
while (benderStepper.currentPosition() != -52 * angleConst) {
benderStepper.setSpeed(-700);
}
delay(100);
// Go back 52 degrees to initial position
while (benderStepper.currentPosition() != 52 * angleConst) {
}
delay(100);
// Feed the same distance again
while (feederStepper.currentPosition() != feedDistance) {
}
feederStepper.setCurrentPosition(0);
delay(100);
servo01.write(130); // Set the bender pin down
delay(200);
// Set bender to new initial position, for bending in the other direction
}
delay(200);
servo01.write(40); // Bender pin up
delay(200);
}
delay(50);
}
delay(100);
servo01.write(130);
count++;
}
}
void cube() {
int feedDistance = feed * 48;
int angleConst = 16;
// Step 1
}
delay(100);
}
delay(100);
}
delay(100);
count++;
}
count = 0;
// Step 2
while (zAxisStepper.currentPosition() != 88 * angleConst) {
zAxisStepper.setSpeed(500);
zAxisStepper.run();
}
zAxisStepper.setCurrentPosition(0);
delay(100);
//Step 3
}
delay(100);
}
delay(100);
}
delay(100);
count++;
}
count = 0;
// Step 4
zAxisStepper.run();
}
delay(100);
// Step 5
servo01.write(130);
delay(200);
}
delay(100);
servo01.write(40);
delay(200);
// Step 6
}
delay(100);
}
delay(100);
}
delay(100);
count++;
}
count = 0;
}
void stand() {
int feedDistance = feed * 48;
int angleConst = 16;
// Step 1
}
delay(100);
}
delay(100);
}
delay(100);
// Step 2
}
delay(100);
}
delay(100);
}
delay(100);
// Step 3
feed = 80; // mm
feedDistance = feed * 48;
}
delay(100);
// Step 4
servo01.write(130);
delay(200);
}
delay(100);
servo01.write(40);
delay(200);
}
delay(100);
}
//Step 5
servo01.write(130);
delay(200);
// Step 6
feed = 80; // mm
}
servo01.write(40);
delay(200);
// Step 7
while (zAxisStepper.currentPosition() != -90 * angleConst) {
zAxisStepper.setSpeed(-500);
zAxisStepper.run();
}
delay(100);
// Step 8
}
delay(100);
}
delay(100);
// Step 6
feed = 45; // mm
}
// Step 10
}
delay(100);
}
delay(100);
// Step 11
zAxisStepper.run();
}
delay(100);
feed = 80; // mm
}
// Step 12
}
delay(100);
}
//Step 13
servo01.write(130);
delay(200);
feed = 80; // mm
}
servo01.write(40);
delay(200);
// Step 14
}
delay(100);
}
delay(100);
//Step 15
feed = 25; // mm
}
delay(100);
// Step 16
}
delay(100);
}
delay(100);
// Step 17
}
}
void manual() {
int sign;
String dataInS;
int angle;
int angleConst;
Serial.println(" // MANUAL MODE //");
while (!dataIn.startsWith("end")) {
servo01.write(130);
delay(200);
dataIn = Serial.readString();
if (dataIn.startsWith("f")) {
dataInS = dataIn.substring(1, dataIn.length()); // reads the feed value
dist = dataInS.toInt();
Serial.print("Feed ");
Serial.print(dist);
Serial.println("mm wire.");
dist = dist * 48;
while (feederStepper.currentPosition() != dist) {
}
delay(100);
}
if (dataIn.startsWith("b")) {
if (dataIn.charAt(1) == '-') {
dataInS = dataIn.substring(2, dataIn.length()); ///reads the angle value
angle = dataInS.toInt();
Serial.print("Bend -");
Serial.print(angle);
Serial.println(" degrees.");
angleConst = 16;
// Set "negative" bending initial position
}
delay(100);
servo01.write(40);
delay(200);
// Bend the wire
while (benderStepper.currentPosition() != angle * angleConst) {
}
delay(100);
while (benderStepper.currentPosition() != (-1) * angle * angleConst) {
}
delay(100);
servo01.write(130);
delay(200);
// Get back to original "positive" bending initial poistion
}
delay(100);
}
else {
dataInS = dataIn.substring(1, dataIn.length());
Serial.print("Bend ");
angleConst = 16;
servo01.write(40);
delay(200);
while (benderStepper.currentPosition() != (-1) *angle * angleConst) {
}
delay(100);
while (benderStepper.currentPosition() != angle * angleConst) {
}
delay(100);
}
angleConst = 16;
while (benderStepper.currentPosition() != sign * angle * angleConst) {
}
delay(100);
while (benderStepper.currentPosition() != sign * angle * angleConst) {
}
delay(100);
}
// Z-Axis Control
if (dataIn.startsWith("z")) {
if (dataIn.charAt(1) == '-') {
Serial.print("Move Z-Axis -");
angleConst = 16;
while (zAxisStepper.currentPosition() != angle * angleConst) {
zAxisStepper.run();
}
delay(100);
}
else {
Serial.print("Move Z-Axis ");
angleConst = 16;
while (zAxisStepper.currentPosition() != (-1) *angle * angleConst) {
zAxisStepper.setSpeed(-500);
zAxisStepper.run();
}
delay(100);
}
}
manualStatus = dataIn;
}
}

Arduino Notebook v1-1

Uploaded by

Document Information

Original Description:

Copyright

Available Formats

Share this document

Share or Embed Document

Sharing Options

Did you find this document useful?

Is this content inappropriate?

Copyright:

Available Formats

Arduino Notebook v1-1

Uploaded by

Copyright:

Available Formats

/*

Arduino 3D Wire Bending Machine

You might also like