求教1200的MODBUS CRC16程序

FUNCTION "fcCRC16_ModbusRTU" : Void
VAR_INPUT
    uiInNumBytes : UInt; // 输入字节数
END_VAR
VAR_OUTPUT
    byOutCRCHigh : Byte; // 输出CRC高字节
    byOutCRCLow : Byte; // 输出CRC低字节
END_VAR
VAR_IN_OUT
    byInputArray : Array[*] of Byte; // 输入字节数组
END_VAR
VAR_TEMP
    iTempLowerLimit : DInt; // 数组下界
    iTempUpperLimit : DInt; // 数组上界
    wTempCRC : Word; // 临时CRC值
    iByteIndex : Int; // 字节索引
    iBitIndex : Int; // 位索引
    wTemp : Word; // 临时变量
END_VAR
VAR_CONSTANT
    cwXor : Word := 16#A001; // CRC多项式
    cwStart : Word := 16#FFFF; // CRC初始值
END_VAR

// 获取数组上下界
iTempLowerLimit := LOWER_BOUND(byInputArray);
iTempUpperLimit := UPPER_BOUND(byInputArray);

// 动态调整上界
IF uiInNumBytes < (iTempUpperLimit - iTempLowerLimit + 1) THEN
    iTempUpperLimit := iTempLowerLimit + uiInNumBytes - 1;
END_IF

// 初始化CRC寄存器
wTempCRC := cwStart;

// 主循环处理每个字节
FOR iByteIndex := iTempLowerLimit TO iTempUpperLimit DO
    // 字节异或操作
    wTempCRC := wTempCRC XOR byInputArray[iByteIndex];
    
    // 内嵌位循环处理每一位
    FOR iBitIndex := 0 TO 7 DO
        // 右移操作
        wTemp := wTempCRC SHR 1;
        
        // 判断最低位是否为1
        IF (wTempCRC AND 1) = 1 THEN
            wTempCRC := wTemp XOR cwXor;
        ELSE
            wTempCRC := wTemp;
        END_IF;
    END_FOR;
END_FOR;

// 输出CRC高、低字节
byOutCRCHigh := BYTE#(wTempCRC SHR 8);
byOutCRCLow := BYTE#(wTempCRC AND 255);
END_FUNCTION