diff --git a/afsk/main.c b/afsk/main.c index 18eb3bc3..8cf5dc4e 100644 --- a/afsk/main.c +++ b/afsk/main.c @@ -980,8 +980,8 @@ if (firstTime != ON) double time = (millis() - time_start)/1000.0; double Xi = 5.0 * sin(1.57) * sin(2.0 * 3.14 * time / 46.0); - double Yi = 5.0 * sin(1.57) * sin(2.0 * 3.14 * time / 46.0 + 3.14/2.0); - double Zi = 5.0 * cos(1.57 - 0.0) * sin(2.0 * 3.14 * time / 46.0 + 3.14); + double Yi = 5.0 * sin(1.57) * sin((2.0 * 3.14 * time / 46.0) + 3.14/2.0); + double Zi = 5.0 * cos(1.57 - 0.0) * sin((2.0 * 3.14 * time / 46.0) + 3.14); current[map[PLUS_X]] = ( Xi >= 0) ? Xi: 0; current[map[MINUS_X]] = ( Xi >= 0) ? 0: ((-1.0) * Xi);