ManuelW/grbl-LPC-CoreXY
1
0
Fork 0
Code Issues Pull Requests Releases 1 Wiki Activity

fixed synchronization problem with spindle_control

Browse Source
This commit is contained in:
Simen Svale Skogsrud 2011-02-25 13:30:03 +01:00
parent a18a89c779
commit 4cac11ec86
1 changed files with 13 additions and 9 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
spindle_control.c
View File

@ -25,13 +25,16 @@
#include <avr/io.h> #include <avr/io.h>
static int current_direction;
void spindle_init() void spindle_init()
{ {
SPINDLE_ENABLE_DDR |= 1<<SPINDLE_ENABLE_BIT; spindle_run(0, 0);
} }
void spindle_run(int direction, uint32_t rpm) void spindle_run(int direction, uint32_t rpm)
{ {
if (direction != current_direction) {
st_synchronize(); st_synchronize();
if(direction >= 0) { if(direction >= 0) {
SPINDLE_DIRECTION_PORT &= ~(1<<SPINDLE_DIRECTION_BIT); SPINDLE_DIRECTION_PORT &= ~(1<<SPINDLE_DIRECTION_BIT);
@ -39,10 +42,11 @@ void spindle_run(int direction, uint32_t rpm)
SPINDLE_DIRECTION_PORT |= 1<<SPINDLE_DIRECTION_BIT; SPINDLE_DIRECTION_PORT |= 1<<SPINDLE_DIRECTION_BIT;
} }
SPINDLE_ENABLE_PORT |= 1<<SPINDLE_ENABLE_BIT; SPINDLE_ENABLE_PORT |= 1<<SPINDLE_ENABLE_BIT;
current_direction = direction;
}
} }
void spindle_stop() void spindle_stop()
{ {
st_synchronize(); spindle_run(0, 0);
SPINDLE_ENABLE_PORT &= ~(1<<SPINDLE_ENABLE_BIT);
} }