void testSetSpeed()
{
GalileoSDK sdk = new GalileoSDK();
if (sdk.Connect("71329A5B0F2D68364BB7B44F3F125531E4C7F5BC3BCE2694DFE39B505FF9C730A614FF2790C1",
true, 10000, null,
null) != GALILEO_RETURN_CODE.OK)
{
Console.WriteLine("Connect to server failed");
}
while (true)
{
GalileoStatus status = sdk.GetCurrentStatus();
Console.WriteLine("currentSpeedX: " + status.currentSpeedX);
Console.WriteLine("currentSpeedTheta: " + status.currentSpeedTheta);
sdk.SetSpeed(0.1f, 0f);
Thread.Sleep(5 * 1000);
status = sdk.GetCurrentStatus();
Console.WriteLine("currentSpeedX: " + status.currentSpeedX);
Console.WriteLine("currentSpeedTheta: " + status.currentSpeedTheta);
sdk.SetSpeed(0f, 1f);
Thread.Sleep(5 * 1000);
status = sdk.GetCurrentStatus();
Console.WriteLine("currentSpeedX: " + status.currentSpeedX);
Console.WriteLine("currentSpeedTheta: " + status.currentSpeedTheta);
sdk.SetSpeed(-0.1f, 0f);
Thread.Sleep(5 * 1000);
status = sdk.GetCurrentStatus();
Console.WriteLine("currentSpeedX: " + status.currentSpeedX);
Console.WriteLine("currentSpeedTheta: " + status.currentSpeedTheta);
sdk.SetSpeed(0f, -1f);
Thread.Sleep(5 * 1000);
status = sdk.GetCurrentStatus();
Console.WriteLine("currentSpeedX: " + status.currentSpeedX);
Console.WriteLine("currentSpeedTheta: " + status.currentSpeedTheta);
sdk.SetSpeed(0f, 0f);
Thread.Sleep(5 * 1000);
status = sdk.GetCurrentStatus();
Console.WriteLine("currentSpeedX: " + status.currentSpeedX);
Console.WriteLine("currentSpeedTheta: " + status.currentSpeedTheta);
}
}
