QCPU的PID指令用ST語言做成功能塊使用, 有興趣的請參考, 下方程序是2個(gè)LOOP例子。
1. 做成2個(gè)功能塊,一個(gè)是PID_Initial, 另一個(gè)是PID_Control
2. PID_Initial 只要執(zhí)行一次, PID_Control每一個(gè)LOOP執(zhí)行一次。
3. PID_Initial 程序
    DB_PID_2.Loops_Number:=2;
    DB_PID_2.Loops_Execute:=1;
    SD794:=HFFFF;    SD795:=HFFFF;    (* No Limit *)    
    DB_PID_2.Loop1_Operation:=1;            (* 1=Reverse *)
    DB_PID_2.Loop1_Ts:=10;            (* Cycle Time *10ms *)
    DB_PID_2.Loop1_Kp:=100;            (* *0.01 *)
    DB_PID_2.Loop1_Ti:=100;            (* *0.1s *)
    DB_PID_2.Loop1_Td:=100;            (* *10ms *)
    DB_PID_2.Loop1_Filter:=10;
    DB_PID_2.Loop1_MVLL:=-32767;
    DB_PID_2.Loop1_MVHL:=32767;
    DB_PID_2.Loop1_DMVL:=100;
    DB_PID_2.Loop1_DPVL:=100;
    DB_PID_2.Loop1_sys1:=0;
    DB_PID_2.Loop1_Kd:=800;            (* *0.01 *)
    DB_PID_2.Loop1_sys2:=0;
    DB_PID_2.Loop1_sys3:=0;
    BMOV( 1 , DB_PID_2.Loop1_Operation , 14 , DB_PID_2.Loop2_Operation );
    S_PIDINIT( 1 , DB_PID_2.Loops_Number );
    DB_PID_2.Loop1_SV:=0;
    DB_PID_2.Loop1_PV:=0;
    DB_PID_2.Loop1_MVman:=0;
    DB_PID_2.Loop1_Auto:=0;
    DB_PID_2.Loop1_Alarm:=0;
    DB_PID_2.Loop2_SV:=0;
    DB_PID_2.Loop2_PV:=0;
    DB_PID_2.Loop2_MVman:=0;
    DB_PID_2.Loop2_Auto:=0;
    DB_PID_2.Loop2_Alarm:=0;

4. PID_Control程序
nAuto:=0;
IF Auto_Man THEN nAuto:=1; END_IF;
CASE Loop_Num OF
    1:
        DB_PID_2.Loop1_SV:=SV;
        DB_PID_2.Loop1_PV:=PV;
        DB_PID_2.Loop1_MVman:=MV_Man;
        DB_PID_2.Loop1_Auto:=nAuto;
        MV:=DB_PID_2.Loop1_MV;
    2:
        DB_PID_2.Loop2_SV:=SV;
        DB_PID_2.Loop2_PV:=PV;
        DB_PID_2.Loop2_MVman:=MV_Man;
        DB_PID_2.Loop2_Auto:=nAuto;
        MV:=DB_PID_2.Loop2_MV;
END_CASE;

我整理一下,再發(fā)出來。