removed the duplicate bit shifting in favor of single operation in function.

This commit is contained in:
jakeg00dwin 2025-02-23 12:29:52 -08:00
parent b64c306250
commit 87b1cb9acd
2 changed files with 13 additions and 14 deletions

View File

@ -105,7 +105,7 @@ void InitProg(void);
/** /**
* @brief Reads the ADC pin from the fader. * @brief Reads the ADC pin from the fader.
*/ */
uint16_t ReadFader(void); uint8_t ReadFader(void);
/** /**

View File

@ -104,7 +104,7 @@ uint8_t ReadSpeed(void) {
} }
// change to ReadFader(void) // change to ReadFader(void)
uint16_t ReadFader(void) { uint8_t ReadFader(void) {
// Initialize ADC // Initialize ADC
ADMUX = (1 << MUX1) | (1 << MUX0); // Select ADC3 (PB3) ADMUX = (1 << MUX1) | (1 << MUX0); // Select ADC3 (PB3)
ADCSRA = (1 << ADEN) | (1 << ADPS1) | (1 << ADPS0); // Enable ADC, prescaler 8 ADCSRA = (1 << ADEN) | (1 << ADPS1) | (1 << ADPS0); // Enable ADC, prescaler 8
@ -112,7 +112,7 @@ uint16_t ReadFader(void) {
ADCSRA |= (1 << ADSC); // Start conversion ADCSRA |= (1 << ADSC); // Start conversion
while (ADCSRA & (1 << ADSC)) { while (ADCSRA & (1 << ADSC)) {
} // Wait for conversion to finish } // Wait for conversion to finish
return ADC; return (uint8_t)(ADC >> 2);
} }
/* /*
@ -129,25 +129,24 @@ static inline uint8_t diff(uint8_t a, uint8_t b) {
} }
void MotorSetSavePos(uint8_t *ADR) { void MotorSetSavePos(uint8_t *ADR) {
uint8_t pos = (uint8_t)(ReadFader() >> 2); uint8_t pos = ReadFader();
//eeprom_write_byte((uint8_t *)ADR, pos); eeprom_write_byte((uint8_t *)ADR, pos);
eeprom_update_byte((uint8_t *)ADR, pos);
return; return;
} }
uint8_t MotorGetSavedPos(uint8_t *ADR) { uint8_t MotorGetSavedPos(uint8_t *ADR) {
return (uint8_t)eeprom_read_byte((uint8_t *)POSITION1_ADR); return (uint8_t)eeprom_read_byte((uint8_t *)ADR);
} }
void MotorMoveTo(uint8_t target) { void MotorMoveTo(uint8_t target) {
uint8_t on_delay = ReadSpeed(); uint8_t on_delay = ReadSpeed();
uint8_t pos = (uint8_t)(ReadFader() >> 2); uint8_t pos = ReadFader();
uint8_t idx = 0; uint8_t idx = 0;
while (diff(target, pos) > 8) { while (diff(target, pos) > 4) {
on_delay = ReadSpeed(); on_delay = ReadSpeed();
pos = (uint8_t)(ReadFader() >> 2); pos = ReadFader();
if (target > pos) { if (target > pos) {
MotorMove(1); MotorMove(1);
} else { } else {
@ -270,14 +269,14 @@ static void UpdateButtonOutput(btn_state *b) {
/*If the button pres was a short one.*/ /*If the button pres was a short one.*/
else if (!b->is_long_pressed) { else if (!b->is_long_pressed) {
if (b->is_active) { if (b->is_active) {
/*Save the current position into position 2 EEPROM*/
MotorSetSavePos((uint8_t *)POSITION2_ADR);
/*If already in saved position then go back to original pos.*/ /*If already in saved position then go back to original pos.*/
if(diff(MotorGetSavedPos((uint8_t *)POSITION1_ADR), ReadFader()) > 8){ if(diff(MotorGetSavedPos((uint8_t *)POSITION1_ADR), ReadFader()) < 4){
MotorMoveTo(MotorGetSavedPos((uint8_t *)POSITION1_ADR)); MotorMoveTo(MotorGetSavedPos((uint8_t *)POSITION2_ADR));
} }
else{ else{
/*Save the current position into position 2 EEPROM*/
MotorSetSavePos((uint8_t *)POSITION2_ADR);
MotorMoveTo(MotorGetSavedPos((uint8_t *)POSITION1_ADR)); MotorMoveTo(MotorGetSavedPos((uint8_t *)POSITION1_ADR));
} }
} else { } else {