Линия Robotc следует кодам должна быть быстрее

Question

Для получения полной информации прочитайте документацию Robocup.

Я делаю старшее спасение, Если бы вы могли мне помочь, я был бы очень счастлив.

Благодарю.

int diff;
long redValue1;
long greenValue1;
long blueValue1;
long redValue2;
long greenValue2;
long blueValue2;

task main()
{
    repeat(forever)
    {
        getColorRGB(S1, redValue1, greenValue1, blueValue1);
        getColorRGB(S2, redValue2, greenValue2, blueValue2);
        diff = greenValue1-greenValue2;
        diff = diff*2;
        motor[motorA] = -30 -diff;
        motor[motorB] = diff+ -30;
        if (getUSDistance(S3)<10)
        {
            motor[motorA] = -20;
            motor[motorB] = 20;
            delay(800);
            motor[motorA] = -20;
            motor[motorB] = -20;
            delay(1200);
            motor[motorA] = 20;
            motor[motorB] = -20;
            delay(800);
            motor[motorA] = -20;
            motor[motorB] = -20;
            delay(3000);
            motor[motorA] = 20;
            motor[motorB] = -20;
            delay(800);
            motor[motorA] = -20;
            motor[motorB] = -20;
            delay(1200);
            motor[motorA] = -20;
            motor[motorB] = 20;
            delay(800);
        }


        if (greenValue1>14 && redValue1<10 && blueValue1<10
            && greenValue2>14  && redValue2<10 && blueValue2<10){
            playTone(200, 10);

            motor[motorA] = -20;
            motor[motorB] = -20;
            delay(2000);
            motor[motorA] = -20;
            motor[motorA] = 20;
            delay(3000);
            motor[motorA] = -20;
            motor[motorA] = 20;
            waitUntil(getUSDistance(S3)<40);
            motor[motorA] = -60;
            motor[motorA] = -60;
            motor[motorB] = -60;
            motor[motorA] = -60;
            motor[motorB] = -60;
            delay(1000);
            motor[motorA] = 60;
            motor[motorB] = 60;
            delay(600);

        }else{


        }

        if (greenValue1>14 && redValue1<7 && blueValue1<7){
            delay(100);
            motor[motorA] = 40;
            motor[motorB] = -40;
            delay(250);
            }else{

        }

        if (greenValue2>14 && redValue2<7 && blueValue2<7){
            delay(100);
            motor[motorA] = -40;
            motor[motorB] = 40;
            delay(250);
        }else{

        }
    }
}

Следующие строки - от 1-й до 10-й строки. Я пытаюсь увеличить скорость до 100. Но я не могу получить правильную пропорцию.

Answer 1

Я лично не использовал более одного датчика освещенности на NXT для отслеживания освещения. Но вы должны быть в состоянии получить приличную скорость с одним датчиком. Я постараюсь объяснить код о том, как сделать это ниже.

(Я не очень знаком с RobotC для NXT, извините!)

float diff; // change this to float
long redValue1;
long greenValue1;
long blueValue1;
long redValue2;
long greenValue2;
long blueValue2;

float kP = 0.5;
long targetSpeed = -30; 
long targetGreenValue = 67;
// I don't know what this value should be. I suggest approximately 2/3rds toward white.
// If fully black = 0 and fully white = 100, then I would try 67.

task main()
{
    repeat(forever)
    {
        getColorRGB(S1, redValue1, greenValue1, blueValue1);
        diff = (greenValue1 - targetGreenValue)(float) * kP;
        motor[motorA] = targetSpeed - round(diff);
        motor[motorB] = targetSpeed + round(diff);
        delay(10); // This is milliseconds, right?
    }
}