Разница между визуальным программированием NXT-G и NXC-подобным программированием Lego brick

Question

Я подхожу к программированию на Lego NXT и начал с очень хорошего сайта http://nxtprograms.com/. В частности, я следовал инструкциям для простого Segway с датчиком освещенности в качестве датчика балансировки (http://nxtprograms.com/NXT2/segway/index.html). Я изучил его (Dave Parker) программу NXT-G и успешно скопировал на его роботе и на более простую пользовательскую версию (без "драйвера"). Все работает, либо его программа, и моя. Я сразу же переключился на программирование NXC, потому что я уже знаю язык C и хотел использовать большую потенциальную возможность. Я хорошо воспроизвел алгоритм балансировки с теми же константами PID и вычислениями. В результате программа на C просто не работает: робот уравновешивает себя на 1 или 2 секунды, колебания больше, чем у NXT-G, и он падает.

Я сравнил базовую логику NXT-G и C, не обнаружив никакой разницы. Поэтому мне интересно, если что-то не так, в моей программе, с управлением двигателем. Я полагаю, что графический блок NXT-G, управляющий двигателями, делает нечто большее, просто вызывая OnFwdSync(...)/OnRevSync(...). Это объясняет, почему моя программа генерирует большие начальные колебания.

У кого-нибудь есть пример программы NXC, управляющей этим простым segway-lego, или можете объяснить, почему не работает управление двигателем в моей программе? Внизу я приложил исходный код моей программы.

Благодарю.

#define KP 25
#define KI 1
#define KD 10
#define KO 0.5
#define LSAMPLE 100
//#include "MotorActions.nbc"

int balance(const int RIF)
{
  int output = 0;
  int previous_error = 0;
  int error = 0;
  int I = 0;
  int D = 0;
  int counter = 0;
  int actual;

  while (true)
  {
    actual = SENSOR_3;
    error = actual - RIF;
    counter++;
    I += error;
    D = (error - previous_error);
    previous_error = error;
    /**
     *  Compute de PID compensation
     */
    output = KO * (KP * error + KI * I + KD * D);
    if ((output > 1000) || (output < -1000)) 
      break;
    if (output < 0)
      OnFwdSync(OUT_BC, -output, 0);
    else
      OnRevSync(OUT_BC, output, 0);
  }
  return (counter);
}

int read_light()
{
  int L = 0;
  int ctr = 0;

  while (ctr < LSAMPLE)
  {
    L += SENSOR_3;
    ctr++;
    Wait(10);
  }
  return (L / LSAMPLE);
}

task main()
{
  int i = 0;
  int RIF;
  int count;

  while (i++ < 3)
  {
    //PlaySound(SOUND_LOW_BEEP);
    Wait(800);
  }
  Wait(400);
  //PlaySound( SOUND_DOUBLE_BEEP );
  SetSensorColorRed(IN_3);
  ClearSensor(SENSOR_3);
  RIF = SENSOR_3;
  count = balance(RIF);
  Off(OUT_BC);
}

Answer 1

Попробуйте изменить ваши константы. Попробуйте поднять КП до большего значения, 32, может быть?