josh
/
Teacup_Firmware
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Debounce direction as well as step

This commit is contained in:
Michael Moon 2010-01-15 13:39:00 +11:00
parent 4463e2b945
commit 1af9eacefb
1 changed files with 25 additions and 12 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

37
stepper-2/stepper.c
View File

@ -156,6 +156,7 @@ int main (void)
uint16_t spinner = 0;
int r;
int32_t rv;
uint8_t input_lastreading;
// setup inputs
DDR_STEP &= ~MASK(PIN_STEP);
@ -210,21 +211,33 @@ int main (void)
for (;;)
{
// check logic inputs
if ((READ_STEP & MASK(PIN_STEP)) == 0) {
if (stepdebounce >= 128) {
if (stepdebounce == 128) {
if (READ_DIR & MASK(PIN_DIR))
npos++;
else
npos--;
stepdebounce++;
if (1) {
uint8_t input_thisreading = (READ_STEP & (MASK(PIN_STEP) | MASK(PIN_DIR)));
// if same as last time
if (input_thisreading == input_lastreading) {
// if we're near debounce threshold
if (stepdebounce >= 32) {
// if we're exactly on the threshold
if (stepdebounce == 32) {
// adjust target position
if (input_thisreading & MASK(PIN_DIR))
npos++;
else
npos--;
// go over threshold so inputs must change before next move
stepdebounce++;
}
}
// approach threshold
else {
stepdebounce++
}
}
else
stepdebounce++;
// if input changed, reset debouncer
else {
stepdebounce = 0;
}
}
else
stepdebounce = 0;
// check serial input
if (serial_rxchars()) {