- CVI 정보나눔(www.cvi.kr)
- 스터디
- 질문답변
질문,답변
글 수 1,629
>이번에 모터 Closed Loop Control을 하려고 하는데여..
>제가 원하는 RPM을 입력으로 넣어주면 DAQ에서 전압을 내보내주고 그게 모터로 가서 제어를 하는 것이거든여..
>근데여 P개인인가.. 그런것을 사용해도 출력이 제가 원하는 입력에 못미친다네요..
>그래서 찾아봤더니 P개인 D개인 I개인을 사용하면 된다는데
>P개인 D개인 I개인이 멀 의미하는지 모르겟어여...
>잘 아시는분 위 개인 공식좀 써주세여...
>그럼 부탁드리겠습니다.. 꾸벅
안녕하세요..야리싸내라고 합니다.
답변이 많이 늦어서해결을 하셨는지 모르겠군요..^^
pid 제어라......^^
야리도 기억이 가물가물한데요...
pid에 대한 개념은 인터넷을 찾아보시면 잘 나와 있구요...
pid를 c 소스코드로 알고리즘화 한 것에 대해 알려드리겠습니다.
속도제어를 위한 아날로그 pid알고리즘은...
OutValue(t) = Kp*error(t) + Ki[error(t) + error(t-1) ] + Kd[(error(t) - error(t-1) ] + OutValue(t-1)
이 됩니다.
아날로그를 디지털로 변환하기 위해서는 샘플링 시간 dT의 개념이 추가되어야 하는데요..
아래의 소스코드는 아날로그 pid알고리즘을 디지털 화 시킨것입니다.
(이것은 야리가 예전에 인터넷을 뒤져서 찾아놓았던 것입니다.)
////////////////////////////////////////////////////////////
////Digital PID Angorithm from INDUSTRIAL CONTROL ELECTRONICS(J.Michael Jacob)
//// Proportional = Kp[e(t) - e(t-1)]
//// Integral = Ki * e(t) *dT
//// Derivative = Kd/dT * [e(t) - 2*e(t-1) + e(t-2)]
//// Out(t) = Out(t-1) + Proportional + Integral + Derivative
////////////////////////////////////////////////////////////
double PID_Control(int ID,double SetPoint,double ProcessValue,
double Kp,double Ki,double Kd,double dT,double *error,double Out)
{
static double oldOut=0.0;
double Integral,Derivative,Proportional;
error[0] = SetPoint - ProcessValue;
Proportional = Kp * (error[0] - error[1]);
Integral = Ki * error[0] * dT;
Derivative = Kd/dT * (error[0] - 2 * olderror[1] + error[2]);
Out = Proportional + Integral + Derivative + oldOut;
error[2] = error[1];
error[1] = error[0];
Out = (Out >1.0) ? 1.0: Out;
Out = (Out <0.0) ? 0.0: Out;
oldOut = Out;
return (Out);
}
////////////////////////////////////////////////////////////////
통상적으로 요즘에는 일반 아날로그알고리즘을 그대로 디지털에서 사용하기도 합니다. 시스템의 성능이 좋아 샘플링 시간이 아주 짧아서 아날로그로 근사화 해도 상관이 없다는 가정하에서요...
그래서 아날로그 알고리즘을 C소스코드화 하면
double PID_Control(int ID,double SetPoint,double ProcessValue,
double Kp,double Ki,double Kd,double dT,double *error,double Out)
{
static double oldOut=0.0;
double Integral,Derivative,Proportional;
// 에러 = 지정값 - 아날로그 입력값
error[0] = SetPoint - ProcessValue;//현재의 에러를 구하고
Proportional = Kp * error[0];//비례 제어값
Integral = Ki *(error[0] +error[1]);//적분제어값
Derivative = Kd * (error[0] - error[1]);//미문제어값
//출력
Out = Proportional + Integral + Derivative + oldOut;
error[1] = error[0];//이전에러를 저장
Out = (Out >1.0) ? 1.0: Out;//출력의 정규화
Out = (Out <0.0) ? 0.0: Out;
oldOut = Out;//이전 출력을 저장
return (Out);
}
이러한 방식으로 알고리즘을 구현하시면 되겠습니다.
야리는 그냥 아날로그 알고리즘을 사용합니다.
사용하기도 간편하거니와 디지털은 컴터의 동작상태에 따라서
반응이 달라지더라구요...^^
그럼..