apo
/
STM32F4DoorControl
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Reduce speed to 0 after some time

main
Valentin Ochs 2021-08-15 17:42:20 +02:00
parent bb32eb6614
commit 9992331c97
1 changed files with 3 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
encoder.c
View File

@ -5,6 +5,7 @@
#include <stddef.h> #include <stddef.h>
#include <stdint.h> #include <stdint.h>
#include <stdio.h> #include <stdio.h>
#include <string.h>
#include "encoder.h" #include "encoder.h"
#include "systick.h" #include "systick.h"
@ -77,8 +78,8 @@ int encoder_speed() {
int encoder_current_speed() { int encoder_current_speed() {
int dt = ticks_ms(tick - speed_ticks[SPEED_AVG_NUM - 1].tick); int dt = ticks_ms(tick - speed_ticks[SPEED_AVG_NUM - 1].tick);
if (dt > 200) { if (dt > 200) {
printf("dt: %d", dt); memmove(&speed_ticks[0], &speed_ticks[1], SPEED_AVG_NUM * sizeof speed_ticks[0]);
return 0; speed_ticks[SPEED_AVG_NUM].tick = tick;
} }
return 1000 return 1000
* (speed_ticks[SPEED_AVG_NUM-1].pos - speed_ticks[0].pos) * (speed_ticks[SPEED_AVG_NUM-1].pos - speed_ticks[0].pos)