move clock functions from mendel.c to clock.[ch]
This commit is contained in:
parent
a57ba313b8
commit
935eed7f97
2
Makefile
2
Makefile
|
|
@ -96,7 +96,7 @@ PROGBAUD = 57600
|
||||||
|
|
||||||
PROGRAM = mendel
|
PROGRAM = mendel
|
||||||
|
|
||||||
SOURCES = $(PROGRAM).c serial.c dda.c gcode_parse.c gcode_process.c timer.c temp.c sermsg.c dda_queue.c watchdog.c debug.c sersendf.c heater.c analog.c delay.c intercom.c pinio.c
|
SOURCES = $(PROGRAM).c serial.c dda.c gcode_parse.c gcode_process.c timer.c temp.c sermsg.c dda_queue.c watchdog.c debug.c sersendf.c heater.c analog.c delay.c intercom.c pinio.c clock.c
|
||||||
|
|
||||||
ARCH = avr-
|
ARCH = avr-
|
||||||
CC = $(ARCH)gcc
|
CC = $(ARCH)gcc
|
||||||
|
|
|
||||||
|
|
@ -0,0 +1,45 @@
|
||||||
|
#include "clock.h"
|
||||||
|
|
||||||
|
#include "pinio.h"
|
||||||
|
#include "sersendf.h"
|
||||||
|
#include "dda_queue.h"
|
||||||
|
#include "watchdog.h"
|
||||||
|
#include "temp.h"
|
||||||
|
#include "timer.h"
|
||||||
|
#include "debug.h"
|
||||||
|
|
||||||
|
void clock_250ms() {
|
||||||
|
if (steptimeout > (30 * 4)) {
|
||||||
|
power_off();
|
||||||
|
}
|
||||||
|
else
|
||||||
|
steptimeout++;
|
||||||
|
|
||||||
|
ifclock(CLOCK_FLAG_1S) {
|
||||||
|
if (debug_flags & DEBUG_POSITION) {
|
||||||
|
// current position
|
||||||
|
sersendf_P(PSTR("Pos: %ld,%ld,%ld,%ld,%lu\n"), current_position.X, current_position.Y, current_position.Z, current_position.E, current_position.F);
|
||||||
|
|
||||||
|
// target position
|
||||||
|
sersendf_P(PSTR("Dst: %ld,%ld,%ld,%ld,%lu\n"), movebuffer[mb_tail].endpoint.X, movebuffer[mb_tail].endpoint.Y, movebuffer[mb_tail].endpoint.Z, movebuffer[mb_tail].endpoint.E, movebuffer[mb_tail].endpoint.F);
|
||||||
|
|
||||||
|
// Queue
|
||||||
|
print_queue();
|
||||||
|
}
|
||||||
|
// temperature
|
||||||
|
/* if (temp_get_target())
|
||||||
|
temp_print();*/
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void clock_10ms() {
|
||||||
|
// reset watchdog
|
||||||
|
wd_reset();
|
||||||
|
|
||||||
|
temp_tick();
|
||||||
|
|
||||||
|
ifclock(CLOCK_FLAG_250MS) {
|
||||||
|
clock_250ms();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
@ -0,0 +1,7 @@
|
||||||
|
#ifndef _CLOCK_H
|
||||||
|
#define _CLOCK_H
|
||||||
|
|
||||||
|
void clock_250ms(void);
|
||||||
|
void clock_10ms(void);
|
||||||
|
|
||||||
|
#endif /* _CLOCK_H */
|
||||||
36
mendel.c
36
mendel.c
|
|
@ -18,6 +18,7 @@
|
||||||
#include "analog.h"
|
#include "analog.h"
|
||||||
#include "pinio.h"
|
#include "pinio.h"
|
||||||
#include "arduino.h"
|
#include "arduino.h"
|
||||||
|
#include "clock.h"
|
||||||
|
|
||||||
void io_init(void) {
|
void io_init(void) {
|
||||||
// disable modules we don't use
|
// disable modules we don't use
|
||||||
|
|
@ -150,41 +151,6 @@ void init(void) {
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void clock_250ms(void) {
|
|
||||||
if (steptimeout > (30 * 4)) {
|
|
||||||
power_off();
|
|
||||||
}
|
|
||||||
else
|
|
||||||
steptimeout++;
|
|
||||||
|
|
||||||
ifclock(CLOCK_FLAG_1S) {
|
|
||||||
if (debug_flags & DEBUG_POSITION) {
|
|
||||||
// current position
|
|
||||||
sersendf_P(PSTR("Pos: %ld,%ld,%ld,%ld,%lu\n"), current_position.X, current_position.Y, current_position.Z, current_position.E, current_position.F);
|
|
||||||
|
|
||||||
// target position
|
|
||||||
sersendf_P(PSTR("Dst: %ld,%ld,%ld,%ld,%lu\n"), movebuffer[mb_tail].endpoint.X, movebuffer[mb_tail].endpoint.Y, movebuffer[mb_tail].endpoint.Z, movebuffer[mb_tail].endpoint.E, movebuffer[mb_tail].endpoint.F);
|
|
||||||
|
|
||||||
// Queue
|
|
||||||
print_queue();
|
|
||||||
}
|
|
||||||
// temperature
|
|
||||||
/* if (temp_get_target())
|
|
||||||
temp_print();*/
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void clock_10ms(void) {
|
|
||||||
// reset watchdog
|
|
||||||
wd_reset();
|
|
||||||
|
|
||||||
temp_tick();
|
|
||||||
|
|
||||||
ifclock(CLOCK_FLAG_250MS) {
|
|
||||||
clock_250ms();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
int main (void)
|
int main (void)
|
||||||
{
|
{
|
||||||
init();
|
init();
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue