void Move(double x, double y)
{
    double m1 = x + y;
    double m2 = x - y;

    // Daca robotul merge cu spatele, inverseaza m1 si m2
    if (x < 0)
    {
        double aux = m1;
        m1 = m2;
        m2 = aux;
    }

    // Incadrare m1 si m2 intre -1 si 1
    if (m1 > 1)
        m1 = 1;
    if (m1 < -1)
        m1 = -1;

    if (m2 > 1)
        m2 = 1;
    if (m2 < -1)
        m2 = -1;

    // Setare viteza
    motor1.setSpeed(abs((int)(m1 * 255 * 0.85f)));
    motor2.setSpeed(abs((int)(m2 * 255 * 0.85f)));

    // Setare directie pentru fiecare roata
    if (m1 >= 0)
        motor1.run(FORWARD);
    else
        motor1.run(BACKWARD);

    if (m2 >= 0)
        motor2.run(BACKWARD);
    else
        motor2.run(FORWARD);
}
void Stop()
{
    // Oprire motoare
    motor1.setSpeed(0);
    motor1.run(RELEASE);
    motor2.setSpeed(0);
    motor2.run(RELEASE);
}