|
|
|
@ -56,6 +56,8 @@ void do_taenzer(){
|
|
|
|
taenzer_state.pos = 0;
|
|
|
|
taenzer_state.pos = 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if(!taenzer_state.homed && notaus_state == POWER_ON){
|
|
|
|
if(!taenzer_state.homed && notaus_state == POWER_ON){
|
|
|
|
|
|
|
|
ICR4 = 30;
|
|
|
|
|
|
|
|
OCR4A = 15;
|
|
|
|
set_Output(MOTOR_TAENZER_DIR, 1); // direction: up
|
|
|
|
set_Output(MOTOR_TAENZER_DIR, 1); // direction: up
|
|
|
|
TCCR4B |= _BV(CS41); //TURN ON
|
|
|
|
TCCR4B |= _BV(CS41); //TURN ON
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|