Ejemplo n.º 1
0
void PID_Speed(int32_t currSpeed, int32_t setSpeed, bool isLeft) {
  if (isLeft) {
    PID_SpeedCfg(currSpeed, setSpeed, isLeft, &speedLeftConfig);
  } else {
    PID_SpeedCfg(currSpeed, setSpeed, isLeft, &speedRightConfig);
  }
}
Ejemplo n.º 2
0
Archivo: Pid.c Proyecto: Jack67/Sumobot
void PID_Pos(int32_t currPos, int32_t setPos, bool isLeft) {
    /*! \todo Implement position PID */
    if(isLeft)
    {
        //PID_PosCfg(currPos, setPos, isLeft, &posLeftConfig);
        PID_SpeedCfg(0,currPos-setPos,isLeft,&posLeftConfig);
    }
    else
    {
        PID_PosCfg(currPos, setPos, isLeft, &posRightConfig);
    }

}