% Skapad med Modbus Creator
% - OBS! Användaren ansvarar själv för att samma TYPID inte används flera gånger i samma apparat.
%   TYPID 10000-19999 är för användardefinierade enheter
% Skapad med Modbus Creator
DEVICETYPE GrundfosCIM21 NAMED "GrundfosCIM21" TYPEID 18347 IS

 PARAMETER
  Id       : "Adress";
  V14 : "wControlMode" [""];
  V15 : "wOperationMode" [""];
  V16 : "wSetpoint" ["%"]DEC2;
  V17 : "wControlReg" ["bits"];  % anpassad så att 1=start och 0=stop, detta är inte enligt modbus manualen för Grundfos utan för att styret använder det.

 PUBLIC
  V1 : "PumpStatus" ["bits"];
  V5 : "AlarmCode" [""];
  V6 : "Head" ["bar"]DEC3;
  V7 : "VolumeFlow" ["m3/h"]DEC1;
  
  V21 : "Power" ["W"]; % 32bit
  V22 : "PumpLiquidTemp" ["°C"]DEC2;
  V24 : "Energy" ["kWh"]DEC2; % 32bit
  V26 : "RemoteTemp" ["°C"]DEC2;
  V28 : "HeatEnergyCounter" ["kWh"]; % 32bit
  V29 : "HeatPower" ["W"]; % 32bit
  V210 : "HeatDiffTemp" ["°C"]DEC2;
  
 PRIVATE
  count3;
  count6;
  tmp;

 BAUDRATE 38400;
 CHECKSUM MODBUS SWAPPED;

 TELEGRAM Read3 NAMED "Read 3" IS
  QUESTION
   DATA[0] := BYTE(Id); % Enhetens Modbus adress
   DATA[1] :=  HEX(03); % Modbus kommando för att läsa register
   DATA[2] <- RWORD(
    IF(count3>3) THEN count3 := 0; ENDIF;
    IF (count3=0) THEN tmp := 201;
    ELSIF (count3=1) THEN tmp := 205;
    ELSIF (count3=2) THEN tmp := 302;
    ELSIF (count3=3) THEN tmp := 303;
    ENDIF;
    DATA:= tmp;
   );
   DATA[4] := RWORD(01);
  ANSWER SIZE 7   
   DATA[0] = BYTE(Id);
   DATA[1] = HEX(03);
   DATA[3] -> RWORD(
    IF (count3=0) THEN V1 := DATA;
    ELSIF (count3=1) THEN V5 := DATA;
    ELSIF (count3=2) THEN V6 := DATA/1000;
    ELSIF (count3=3) THEN V7 := DATA/10;
    ENDIF;
    count3 := count3+1;
   );
  TIMEOUT 800
 END;
 
 TELEGRAM WriteRegister NAMED "Write Register" IS
  QUESTION
   DATA[0] := BYTE(Id); % Enhetens Modbus adress
   DATA[1] :=  HEX(06); % Modbus kommando för att skriva ett register
   DATA[2] <- RWORD(
    IF(count6>3) THEN count6 := 0; ENDIF;
    IF (count6=0) THEN DATA := 101;
    ELSIF (count6=1) THEN DATA := 102;
    ELSIF (count6=2) THEN DATA := 103;
    ELSIF (count6=3) THEN DATA := 100;
    ENDIF;
   ); % Register adress
   DATA[4] <- RWORD(
    IF (count6=0) THEN DATA := V14;
    ELSIF (count6=1) THEN DATA := V15;
    ELSIF (count6=2) THEN DATA := V16*100;
    ELSIF (count6=3) THEN IF (V17=0) THEN DATA := 1; ELSE DATA := 3; ENDIF;
    ENDIF;
    count6 := count6+1;
   );
  ANSWER SIZE 8
   DATA[0] = BYTE(Id);
   DATA[1] = HEX(06);
  TIMEOUT 800
 END;
 
 TELEGRAM Read4 NAMED "Read 4" IS
  QUESTION
   DATA[0] := BYTE(Id); % Enhetens Modbus adress
   DATA[1] :=  HEX(04); % Modbus kommando för att läsa register kod 04
   DATA[2] := RWORD(311); % Start address
   DATA[4] := RWORD(45); % Antal register att läsa
  ANSWER SIZE 95 % (Antal register * 2) + 5
   DATA[0] = BYTE(Id);
   DATA[1] = BYTE(04);
   DATA[2] = BYTE(90); % Antal Bytes
   DATA[3] -> RWORD(tmp := DATA * 65536;);%32
   DATA[5] -> RWORD(V21 := tmp + DATA;);
   DATA[23] -> RWORD(V22 := DATA/100;);
   DATA[43] -> RWORD(tmp := DATA * 65536;);%32
   DATA[45] -> RWORD(V24 := (tmp + DATA););
   DATA[53] -> RWORD(V26 := DATA/100;);
   DATA[83] -> RWORD(tmp := DATA * 65536;);%32
   DATA[85] -> RWORD(V28 := (tmp +DATA););%32
   DATA[87] -> RWORD(tmp := DATA * 65536;);%32
   DATA[89] -> RWORD(V29 := DATA + tmp;);%32
   DATA[91] -> RWORD(V210 := DATA/100;);
  TIMEOUT 300
 END;
END;