master
Ondřej Hruška 8 years ago
parent 5e8886579f
commit 4525529d87
  1. 23
      project/main.c

@ -16,14 +16,13 @@
#include "dspin.h" #include "dspin.h"
#include "blinky.h" #include "blinky.h"
// 7.5deg motor -> 48 full steps. We use 128 step mode -> 6144 = full circle // 7.5deg motor -> 48 full steps. We use 128 step mode -> 6144 = full circle
#define STEPS_360 6144 #define STEPS_360 6144
static void poll_subsystems(void); static void poll_subsystems(void);
static void conf_buttons(void); static void conf_buttons(void);
/** Main program function */
int main(void) int main(void)
{ {
hw_init(); hw_init();
@ -55,21 +54,21 @@ int main(void)
} }
} }
/** Left button was pressed */
void left_btn_click(void) void left_btn_click(void)
{ {
led_blink(LED_BUSY, 500); led_blink(LED_BUSY, 100);
dSPIN_Move(FWD, STEPS_360/4); dSPIN_Move(FWD, STEPS_360 / 4); // rotate by 90deg
} }
/** Right button was pressed */
void right_btn_click(void) void right_btn_click(void)
{ {
led_blink(LED_ERROR, 250); led_blink(LED_ERROR, 100);
dSPIN_Move(REV, STEPS_360/4); dSPIN_Move(REV, STEPS_360 / 4); // rotate by -90deg
} }
/** Datagram rx on SBMP */
void dlnk_rx(SBMP_Datagram *dg) void dlnk_rx(SBMP_Datagram *dg)
{ {
(void)dg; (void)dg;
@ -88,7 +87,7 @@ void dlnk_rx(SBMP_Datagram *dg)
} }
} }
/** Configure debouncer and button callbacks */
static void conf_buttons(void) static void conf_buttons(void)
{ {
debounce_init(2); debounce_init(2);
@ -113,7 +112,7 @@ static void conf_buttons(void)
add_periodic_task(debo_periodic_task, NULL, 10, true); add_periodic_task(debo_periodic_task, NULL, 10, true);
} }
/** Poll subsystems, called in the main loop */
static void poll_subsystems(void) static void poll_subsystems(void)
{ {
// poll serial buffers (runs callback) // poll serial buffers (runs callback)

Loading…
Cancel
Save