Algorytm sterowania sinusoidalnego