Commit | Line | Data |
---|---|---|
4cff3ded AW |
1 | /* |
2 | This file is part of Smoothie (http://smoothieware.org/). The motion control part is heavily based on Grbl (https://github.com/simen/grbl). | |
3 | Smoothie is free software: you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation, either version 3 of the License, or (at your option) any later version. | |
4 | Smoothie is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. | |
5 | You should have received a copy of the GNU General Public License along with Smoothie. If not, see <http://www.gnu.org/licenses/>. | |
6 | */ | |
7 | ||
8 | #ifndef ROBOT_H | |
9 | #define ROBOT_H | |
10 | ||
11 | #include <string> | |
12 | using std::string; | |
13 | #include "mbed.h" | |
14 | #include "libs/Module.h" | |
15 | #include "libs/Kernel.h" | |
16 | #include "../communication/utils/Gcode.h" | |
17 | #include "arm_solutions/BaseSolution.h" | |
18 | #include "Planner.h" | |
19 | ||
20 | #define default_seek_rate_checksum 6633 | |
21 | #define default_feed_rate_checksum 47357 | |
22 | #define mm_per_line_segment_checksum 30176 | |
23 | #define mm_per_arc_segment_checksum 15470 | |
b66fb830 | 24 | #define arc_correction_checksum 5074 |
7b470506 AW |
25 | #define x_axis_max_speed_checksum 64935 |
26 | #define y_axis_max_speed_checksum 3752 | |
27 | #define z_axis_max_speed_checksum 7849 | |
4cff3ded AW |
28 | |
29 | #define NEXT_ACTION_DEFAULT 0 | |
30 | #define NEXT_ACTION_DWELL 1 | |
31 | #define NEXT_ACTION_GO_HOME 2 | |
32 | ||
33 | #define MOTION_MODE_SEEK 0 // G0 | |
34 | #define MOTION_MODE_LINEAR 1 // G1 | |
35 | #define MOTION_MODE_CW_ARC 2 // G2 | |
36 | #define MOTION_MODE_CCW_ARC 3 // G3 | |
37 | #define MOTION_MODE_CANCEL 4 // G80 | |
38 | ||
39 | #define PATH_CONTROL_MODE_EXACT_PATH 0 | |
40 | #define PATH_CONTROL_MODE_EXACT_STOP 1 | |
41 | #define PATH_CONTROL_MODE_CONTINOUS 2 | |
42 | ||
43 | #define PROGRAM_FLOW_RUNNING 0 | |
44 | #define PROGRAM_FLOW_PAUSED 1 | |
45 | #define PROGRAM_FLOW_COMPLETED 2 | |
46 | ||
47 | #define SPINDLE_DIRECTION_CW 0 | |
48 | #define SPINDLE_DIRECTION_CCW 1 | |
49 | ||
50 | ||
51 | ||
52 | class Robot : public Module { | |
53 | public: | |
54 | Robot(); | |
55 | void on_module_loaded(); | |
da24d6ae | 56 | void on_config_reload(void* argument); |
4cff3ded AW |
57 | void on_gcode_received(void* argument); |
58 | void execute_gcode(Gcode* gcode); | |
59 | void append_milestone( double target[], double feed_rate); | |
60 | void append_line( double target[], double feed_rate); | |
aab6cbba AW |
61 | //void append_arc(double theta_start, double angular_travel, double radius, double depth, double rate); |
62 | void append_arc( double target[], double offset[], double radius, bool is_clockwise ); | |
63 | ||
64 | ||
4cff3ded AW |
65 | void compute_arc(double offset[], double target[]); |
66 | double to_millimeters(double value); | |
67 | double theta(double x, double y); | |
68 | void select_plane(uint8_t axis_0, uint8_t axis_1, uint8_t axis_2); | |
69 | ||
70 | double current_position[3]; // Current position, in millimeters | |
71 | double last_milestone[3]; // Last position, in millimeters | |
72 | bool inch_mode; // true for inch mode, false for millimeter mode ( default ) | |
73 | bool absolute_mode; // true for absolute mode ( default ), false for relative mode | |
74 | uint8_t motion_mode; // Motion mode for the current received Gcode | |
75 | double seek_rate; // Current rate for seeking moves ( mm/s ) | |
76 | double feed_rate; // Current rate for feeding moves ( mm/s ) | |
77 | uint8_t plane_axis_0, plane_axis_1, plane_axis_2; // Current plane ( XY, XZ, YZ ) | |
78 | BaseSolution* arm_solution; // Selected Arm solution ( millimeters to step calculation ) | |
79 | double mm_per_line_segment; // Setting : Used to split lines into segments | |
b66fb830 AW |
80 | double mm_per_arc_segment; // Setting : Used to split arcs into segmentrs |
81 | ||
82 | // Number of arc generation iterations by small angle approximation before exact arc trajectory | |
83 | // correction. This parameter maybe decreased if there are issues with the accuracy of the arc | |
84 | // generations. In general, the default value is more than enough for the intended CNC applications | |
85 | // of grbl, and should be on the order or greater than the size of the buffer to help with the | |
86 | // computational efficiency of generating arcs. | |
87 | int arc_correction; // Setting : how often to rectify arc computation | |
7b470506 | 88 | double max_speeds[3]; // Setting : max allowable speed in mm/m for each axis |
b66fb830 | 89 | |
4cff3ded AW |
90 | }; |
91 | ||
92 | #endif |