1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
|
/*
3Axis_SNAP.pde - RepRap cartesian firmware for Arduino
History:
* (0.1) Created initial version by Zach Smith <hoeken@rrrf.org>.
* (0.2) Rewrite by Marius Kintel <kintel@sim.no> and Philipp Tiefenbacher <wizards23@gmail.com>
* (0.3) Updated and tested to work with current RepRap host software by Zach Smith <hoeken@rrrf.org>
* (0.4) Updated to work the recent optimizations, ie. removal of LimitSwitch by Zach Smith.
* (0.5) Updated with new library changes by Zach Smith.
License: GPL v2.0
*/
/********************************
* digital i/o pin assignment
********************************/
//this uses the undocumented feature of Arduino - pins 14-19 correspond to analog 0-5
#define X_STEP_PIN 2
#define X_DIR_PIN 3
#define X_MIN_PIN 4
#define X_MAX_PIN 5
#define X_ENABLE_PIN 14
#define Y_STEP_PIN 6
#define Y_DIR_PIN 7
#define Y_MIN_PIN 8
#define Y_MAX_PIN 9
#define Y_ENABLE_PIN 15
#define Z_STEP_PIN 10
#define Z_DIR_PIN 11
#define Z_MIN_PIN 12
#define Z_MAX_PIN 13
#define Z_ENABLE_PIN 16
/********************************
* how many steps do our motors have?
********************************/
#define X_MOTOR_STEPS 400
#define Y_MOTOR_STEPS 400
#define Z_MOTOR_STEPS 400
CartesianBot bot = CartesianBot(
'x', X_MOTOR_STEPS, X_DIR_PIN, X_STEP_PIN, X_MIN_PIN, X_MAX_PIN, X_ENABLE_PIN,
'y', Y_MOTOR_STEPS, Y_DIR_PIN, Y_STEP_PIN, Y_MIN_PIN, Y_MAX_PIN, Y_ENABLE_PIN,
'z', Z_MOTOR_STEPS, Z_DIR_PIN, Z_STEP_PIN, Z_MIN_PIN, Z_MAX_PIN, Z_ENABLE_PIN
);
#include <SNAP.h>
#include <RepStepper.h>
#include <LinearAxis.h>
#include <CartesianBot.h>
#include <CartesianBot_SNAP_v1.h>
void setup()
{
Serial.begin(19200);
//run any setup code we need.
setup_cartesian_bot_snap_v1();
}
void loop()
{
//get our state status / manage our status.
bot.readState();
//process our commands
snap.receivePacket();
if (snap.packetReady())
process_cartesian_bot_snap_commands_v1();
}
|
