|
|
|
@ -1023,7 +1023,7 @@ if (firstTime != ON)
|
|
|
|
float time = (millis() - time_start)/1000.0;
|
|
|
|
float time = (millis() - time_start)/1000.0;
|
|
|
|
posXi = 5.0 * sin(1.57) * sin(2.0 * 3.14 * time / 46.0);
|
|
|
|
posXi = 5.0 * sin(1.57) * sin(2.0 * 3.14 * time / 46.0);
|
|
|
|
|
|
|
|
|
|
|
|
print("Time: %f Xi %f \n",time, posXi);
|
|
|
|
printf("Time: %f Xi %f \n",time, posXi);
|
|
|
|
|
|
|
|
|
|
|
|
posYi = (int)(current[map[PLUS_Y]] + 0.5) + 2048;
|
|
|
|
posYi = (int)(current[map[PLUS_Y]] + 0.5) + 2048;
|
|
|
|
posZi = (int)(current[map[PLUS_Z]] + 0.5) + 2048;
|
|
|
|
posZi = (int)(current[map[PLUS_Z]] + 0.5) + 2048;
|
|
|
|
|