Pinem Dir steruje jako 0 i 1 a pinem STEP jak pwm:
Kod: Zaznacz cały
if (Wlewo == 1 && Wprawo==0)
{
i++;
DIR=1;
if (i>10000)
{
i=0;
f=(1/A)*1500; //oblicznie param PWM na podstawie enkodera
Speed=((1/f)/ppr)*60*1000000; //obliczenie predkosci w rpm
lcd.setCursorPosition(0, 9); //wypis predkosci na LCD
lcd.printf(" ");
lcd.setCursorPosition(0, 9);
lcd.printf("%.0f",Speed);
mypwm.period_us(f); // ustawienie PWM
mypwm.pulsewidth_us(f/2);
}
}