paulM_projects
/
motorized_fader
generated from TDD-Templates/cmake_cpputest_template_avr
2
0
Fork 0
Code Issues 3 Pull Requests Packages Projects Releases 2 Wiki Activity

Added padding to acceptable range for the input.

This commit is contained in:
Jake Goodwin 2025-02-12 15:13:10 -08:00
parent 65536ada8f
commit 088736e2d4
1 changed files with 12 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
src/main.c
View File

@ -101,6 +101,13 @@ uint16_t ReadADC(void) {
* ############################
*/
static inline uint8_t diff(uint8_t a, uint8_t b) {
if(a > b){
return a - b;
}
return b - a;
}
void MotorSetSavePos() {
uint8_t pos = (uint8_t)(ReadADC() >> 2);
eeprom_write_byte((uint8_t *)ROM_SS1_ADR, pos);
@ -115,7 +122,11 @@ void MotorMoveTo(uint8_t target) {
uint8_t pos = 0;
while (target != pos) {
pos = (uint8_t)(ReadADC() >> 2);
if (target > pos) {
if (diff(target, pos) < 8){
MotorCoast();
break;
}
else if (target > pos) {
MotorMove(1);
} else {
MotorMove(0);