PID算法在巡线机器人中的实现

implementing PID algorithm in line following robot

我正在做一个设置了 NXT 头脑风暴的小项目。我的意图是制造一个机器人,它可以非常顺畅且尽可能快地沿着一条线行驶。因此,经过一些小的研究,我找到了 PID 算法,并且能够理解该算法并将其实现为 NXC 代码。机器人刚刚根据算法正确地完成了所有操作,但是当线路中断(间隙)时,机器人失去了线路并且无法返回。问题是,当差距达到 9 厘米时,他可以回来,但在 10 厘米时,他就失去了线。我正在使用一个光传感器。有什么方法可以调整 PID 代码来解决这个问题吗?

我的代码:

    // kd ,ki kp are also defined 
    task main()
   {
    int error = 0;
    float previous_error = 0;
    float setpoint = 0;
    float actual_position = 0;
    int integral = 0;
    float derivative = 0;
    float speed=50;
    float lasterror = 0
    float correction = 0
    float fahrenA = 0
    float fahrenC = 0
    SetSensorLight(IN_2);

    SENSOR_TYPE_LIGHT_ACTIVE;


 while(true)
   { 
      actual_position  = LIGHTSENSOR;
      error = setpoit -  actual_position ;
      integral = error + intergral ;
      derivative = error - previous_error;
      correction = (kp * error )+ (ki * intergral) + (kd  * derivative          );
      turn = correction / 100;
      fahrenA = Tp + turn;
      fahrenC = Tp – turn; 
      OnFwd(OUT_A,fahrenA); 
      OnFwd(OUT_C,fahrenC);
      previous_error = error ;

我们所说的正弦波模式是指机器人可能会遵循以下路径以增加丢失线后重新捕获线的机会。您可以使用简单的 if-else 和 timers/tachometer 读数对路径进行编码。 (感谢@Spektre 的建议!):