Control.com - Nerds in Control

PROGRAM pr
VAR
	flag: BOOL := TRUE;
	Conf: KL6configuration;
	MBdataMy: UINT;
	tempData: INT;

	MBdata: ARRAY[0..99] OF WORD; (* The size of this array can be adapted to the modbus slaves register area *)
	MBd: WORD;

	ModbusAddress: ARRAY[1..23] OF BYTE := 1,2,3,4,5,6,7,8,9,10,11,12,13,14,15,16,17,18,19,20,21,22,23; (* for 23 slaves *)
	MB: ModbusRtuMaster_KL6x5B;
	timeoutvalue: TIME := T#300ms;
	busy: BOOL;
	state: INT;
	tick: DWORD; (* statistical data *)
	lasttick: DWORD; (* statistical data *)
	ModbusCycle: TIME;
	Unit: BYTE;
	temp: UINT;
	tempo: BYTE;
	doneKL: BOOL;
	errorKL: BOOL;
	busyKL: BOOL;

	donewrite: BOOL;
	busywrite: BOOL;

END_VAR

VAR CONSTANT
	Mode : MBserialLineMode_t := MBSERIALLINEMODE_KL6_5B_STANDARD;
END_VAR

MB.ReadRegs(Execute:= FALSE);


IF flag THEN

	Conf(
		Execute:= TRUE,
		Mode := SERIALLINEMODE_KL6_5B_STANDARD,
		Baudrate := 9600,
		NoDatabits := 8,
		Parity := PARITY_NONE,
		Stopbits := 1,
		Handshake := RS485_HALFDUPLEX,
		ContinousMode := TRUE,
		pComIn := ADR( pr.MB.InData),
		pComOut := ADR(pr.MB.OutData ),
		SizeComIn :=SIZEOF(pr.MB.InData),

		Done => doneKL,
		Busy => busyKL,
		Error => errorKL);

	MB.ReadRegs(
		UnitID:= ModbusAddress[23], (* station address *) (*UnitID:= ModbusAddress[Unit], *)
		Quantity:= 1,	(* WORDs *)
		MBAddr:= 2306,		(*Adres na registara, koito 6te se 4ete ot slave-a*)

		cbLength:=2 ,	(* 1 words (cbLength>=Quantity*2)*)
		pMemoryAddr:= ADR(MBd),
		Execute:= TRUE,
		Timeout:= timeoutvalue,
		Busy => busy	);
		flag := FALSE;
END_IF

IF NOT busy THEN
	MB.ReadRegs(Execute:= FALSE);
	state := 0;
	flag := TRUE;
END_IF