Filamentstr
/
05_wickler
Archived
1
0
Fork 0
Code Issues 3 Pull Requests Releases Wiki Activity

new spooling speed regulation

Browse Source 
still needs some tuning
master
Eggert Jung 3 years ago
parent daadb91055
commit 012f133dbe
1 changed files with 15 additions and 4 deletions
Show Stats Download Patch File Download Diff File

19
spule.c
Unescape Escape View File

@ -87,17 +87,28 @@ void do_spule(){
} }
else{ else{
/* speed regulation - keep taenzer at 10% */ /* speed regulation - keep taenzer at 10% */
int32_t tmp = 0;//(100 - (int32_t)taenzer_state.pos/1000); float p = 100.0/(int32_t)(taenzer_state.pos/1000);
p-=1;
p/=2;
p+=1;
//printf("temp1: %d\n", tmp); //printf("temp1: %d\n", tmp);
//TODO fix bounds //TODO fix bounds
//if(tmp < -7500/abzug_speed/2) //if(tmp < -7500/abzug_speed/2)
// tmp = -7500/abzug_speed/2; // tmp = -7500/abzug_speed/2;
//printf("temp2: %d\n", tmp); //printf("temp2: %d\n", tmp);
if(tmp < -35) if(p < 0.75)
tmp = -35; p = 0.75;
if(p > 1.5)
p = 1.5;
ICR5=7500/abzug_speed + tmp; uint16_t base_speed = (7500/abzug_speed);
uint16_t ctrl_speed = base_speed * p;
if(ctrl_speed <= 70)
ctrl_speed = 70;
ICR5 = ctrl_speed;
OCR5C = ICR5/2; OCR5C = ICR5/2;
ICR1 = ICR5/TRANS_ROT_FACTOR; ICR1 = ICR5/TRANS_ROT_FACTOR;