Programming in ST Language.
The example is programmed in ST language. The dedicated section is under the same (MAST).
CASE Function_Step OF
0: (* Initialization *)
IF (Start) THEN (* trigger flag *)
Error := 0;
Function_Step := 5; (* next step *)
END_IF;
5: (* Send command to switch serial port from Slave Modbus mode to Character mode *)
READ_STS(Serial_port); (* read serial port status *)
IF (Serial_port.EXCH_STS = 0) THEN (* no active command *)
Serial_port.CONTROL := 16#00; (* reset control word *)
(* set TO_CHAR_MODE command bit *)
SET(Serial_port.TO_CHAR_MODE);
WRITE_CMD (Serial_port); (* send command *)
Test_inc := 0; (* initialize retry counter *)
Function_Step := 10; (* next step *)
END_IF;
10: (* Test result of switch command to Character mode*)
READ_STS(Serial_port); (* read serial port status *)
IF (Serial_port.EXCH_STS = 0) THEN (* command completed *)
(* reset TO_CHAR_MODE command bit *)
RESET(Serial_port.TO_CHAR_MODE);
IF (Serial_port.EXCH_RPT = 0) THEN (* no error *)
IF (AND(Serial_port.PROTOCOL, 16#0F) = 03)
THEN (* Character mode OK *)
Function_Step := 15; (* next step *)
ELSE
Test_inc := Test_inc + 1;
IF (Test_inc > 1000) THEN
Error := 10; (* error *)
Function_Step := 130; (* next step = end *)
END_IF;
END_IF;
ELSE (* error in sending command to port *)
Error := 10; (* error *)
Function_Step := 130;
END_IF;
END_IF;
15: (* Send dial command to modem *)
(*Phone number must be inserted between ‘ATDT’ and ‘$N’*)
ReqString := 'ATDT4001$N'; (* dial message *)
MngtPrint[2] := 500; (* timeout *)
MngtPrint[9] := 9; (* exchange size in byte *)
PRINT_CHAR(ADDM(Adr_Char), ReqString, MngtPrint);
Function_Step := 20;
20: (* Test PRINT_CHAR function result *)
IF (NOT MngtPrint[0].0) THEN
IF (MngtPrint[1] = 0) THEN
Function_Step := 25; (* success : next step *)
ELSE
Error := 20; (* error *)
Function_Step := 130; (* next step = end *)
END_IF;
END_IF;
25: (* Waiting for the response via INPUT_CHAR *)
MngtInput[2] := 500; (* timeout *)
AnsString1:=' ';
(* wait modem reply *)
INPUT_CHAR(ADDM(Adr_Char), 1, nb_charac_to_receive_connect, MngtInput, AnsString1);
Function_Step := 30; (* next step *)
30: (* Test INPUT_CHAR function result *)
IF (NOT MngtInput[0].0) THEN
IF (MngtInput[1] = 0) THEN
Function_Step := 35; (* success : next step *)
ELSE
Error := 30; (* error *)
Function_Step := 130; (* next step = end *)
END_IF;
END_IF;
35: (* Test Modem reply *)
IF (AnsString1 = '$NCONNET') THEN
Function_Step := 40; (* success : next step *)
ELSE
Error := 35; (* error *)
Function_Step := 130; (* next step = end *)
END_IF;
40: (* Send command to switch serial port from character mode to Modbus Master *)
READ_STS(Serial_port); (* read serial port status *)
IF (Serial_port.EXCH_STS = 0) THEN (* no active command *)
Serial_port.CONTROL := 16#00; (* reset control word *)
(* set TO_MODBUS_MASTER command bit *)
SET(Serial_port.TO_MODBUS_MASTER);
WRITE_CMD (Serial_port); (* send command *)
Test_inc := 0; (* initialize retry counter *)
Function_Step := 45; (* next step *)
END_IF;
45: (* Test result of switch command to Modbus Master mode*)
READ_STS(Serial_port); (* read serial port status *)
IF (Serial_port.EXCH_STS = 0) THEN (* command completed *)
(* TO_MODBUS_MASTER command bit *)
RESET(Serial_port.TO_MODBUS_MASTER);
IF (Serial_port.EXCH_RPT = 0) THEN (* no error *)
IF (AND(Serial_port.PROTOCOL, 16#0F) = 06)
THEN (* Modbus Master mode OK *)
Function_Step := 50; (* next step *)
ELSE
Test_inc := Test_inc + 1;
IF (Test_inc > 1000) THEN
Error := 45; (* error *)
Function_Step := 130; (* next step = end *)
END_IF;
END_IF;
ELSE (* error in sending command to port *)
Error := 45; (* error *)
Function_Step := 130;
END_IF;
END_IF;
50: (*Write information in the second CPU*)
Mngtwrite[2]:=50; (* time outs*)
%MW40:=5; (* value to send *)
WRITE_VAR(ADDM(Adr_modbus),'%MW',100,2,%MW40:2,Mngtwrite);
Function_Step := 55;
55: (* Test WRITE_VAR function result *)
IF (NOT Mngtwrite[0].0) THEN
IF (Mngtwrite[1] = 0) THEN
Function_Step := 60; (* success : next step *)
ELSE
Error := 55; (* error *)
Function_Step := 130; (* next step = end *)
END_IF;
END_IF;
60: (* Send command to switch serial port from Modbus to character mode *)
READ_STS(Serial_port); (* read serial port status *)
IF (Serial_port.EXCH_STS = 0) THEN (* no active command *)
Serial_port.CONTROL := 16#00; (* reset control word *)
(* set TO_CHAR_MODE command bit *)
SET(Serial_port.TO_CHAR_MODE);
WRITE_CMD (Serial_port); (* send command *)
Test_inc := 0; (* initialize retry counter *)
Function_Step := 65; (* next step *)
END_IF;
65: (* Test result of switch command *)
READ_STS(Serial_port); (* read serial port status *)
IF (Serial_port.EXCH_STS = 0) THEN (* command completed *)
(* reset TO_CHAR_MODE command bit *)
RESET(Serial_port.TO_CHAR_MODE);
IF (Serial_port.EXCH_RPT = 0) THEN (* no error *)
IF (AND(Serial_port.PROTOCOL, 16#0F) = 03)
THEN (* character mode OK *)
Function_Step := 70; (* next step *)
ELSE
Test_inc := Test_inc + 1;
IF (Test_inc > 1000) THEN
Error := 65; (* error *)
Function_Step := 130; (* next step = end *)
END_IF;
END_IF;
ELSE (* error in sending command to port *)
Error := 65; (* error *)
Function_Step := 130; (* next step = end *)
END_IF;
END_IF;
70: (* Hangup modem: step 1*)
ReqString := '+++'; (* escape sequence *)
MngtPrint[3] := 3; (* exchange size in byte *)
PRINT_CHAR(ADDM(Adr_Char), ReqString, MngtPrint);
Function_Step := 75; (* next step *)
75: (* Test PRINT_CHAR function result *)
IF (NOT MngtPrint[0].0) THEN
IF (MngtPrint[1] = 0) THEN
(* Success : next step *)
Function_Step := 80;
ELSE
(* End on error *)
Error := 75;
Function_Step := 130;
END_IF;
END_IF;
80:
MngtInput[2] := 50; (* timeout *)
INPUT_CHAR(ADDM(Adr_Char), 1, nb_charac_to_receive_ok, MngtInput, AnsString2); (*Wait modem reply*)
Function_Step := 85; (*next step*)
85: (* Test INPUT_CHAR function result *)
IF (NOT MngtInput[0].0) THEN
IF (MngtInput[1] = 0) THEN
(* Success : next step *)
Function_Step := 90;
ELSE
(* End on error *)
Error := 85;
Function_Step := 130;
END_IF;
END_IF;
90: (* Test Modem reply *)
IF (AnsString2 = '$NOK') THEN
Function_Step := 95; (* success : next step *)
ELSE
Error := 90; (* error *)
Function_Step := 130; (* next step = end *)
END_IF;
95: (* Hangup modem: step 2 *)
ReqString := 'ATH0$N'; (* hangup message *)
MngtPrint[3] := 3; (* exchange size in byte *)
PRINT_CHAR(ADDM(Adr_Char), ReqString, MngtPrint);
Function_Step := 100; (* next step *)
100: (* Test PRINT_CHAR function result *)
IF (NOT MngtPrint[0].0) THEN
IF (MngtPrint[1] = 0) THEN
(* Success : next step *)
Function_Step := 105;
ELSE
(* End on error *)
Error := 100;
Function_Step := 130;
END_IF;
END_IF;
105:
MngtInput[2] := 50; (* timeout *)
INPUT_CHAR(ADDM(Adr_Char), 1, nb_charac_to_receive_ok, MngtInput, AnsString3); (*Wait modem reply*)
Function_Step := 110; (*next step*)
110: (* Test INPUT_CHAR function result *)
IF (NOT MngtInput[0].0) THEN
IF (MngtInput[1] = 0) THEN
(* Success : next step *)
Function_Step := 115;
ELSE
(* End on error *)
Error := 110;
Function_Step := 130;
END_IF;
END_IF;
115: (* Test Modem reply *)
IF (AnsString3 = '$NOK') THEN
Function_Step := 120; (* success : next step *)
ELSE
Error := 115; (* error *)
Function_Step := 130; (* next step = end *)
END_IF;
120: (* Send command to switch serial port from Character mode to Slave Modbus mode *)
READ_STS(Serial_port); (* read serial port status *)
IF (Serial_port.EXCH_STS = 0) THEN (* no activecommand *)
Serial_port.CONTROL := 16#00; (* reset control word *)
(* set TO_MODBUS_SLAVE command bit *)
SET(Serial_port.TO_MODBUS_SLAVE);
WRITE_CMD (Serial_port); (* send command *)
Test_inc := 0; (* initialize retry counter *)
Function_Step := 125; (* next step *)
END_IF;
125: (* Test result of switch command *)
READ_STS(Serial_port); (* read serial port status *)
IF (Serial_port.EXCH_STS = 0) THEN (* command completed *)
(* reset TO_MODBUS_SLAVE command bit *)
RESET(Serial_port.TO_MODBUS_SLAVE);
IF (Serial_port.EXCH_RPT = 0) THEN (* no error *)
IF (AND(Serial_port.PROTOCOL, 16#0F) = 07)
THEN (* character mode OK *)
Function_Step := 130; (* next step *)
ELSE
Test_inc := Test_inc + 1;
IF (Test_inc > 1000) THEN
Error := 125; (* error *)
Function_Step := 130; (* next step = end *)
END_IF;
END_IF;
ELSE (* error in sending command to port *)
Error := 125; (* error *)
Function_Step := 130; (* next step = end *)
END_IF;
END_IF;
130: (* End *)
IF (NOT Start) THEN (* trigger flag *)
Function_Step := 0; (* goto waiting state *)
END_IF;
END_CASE;