защиты по контролю скорости

[alexval2006]

Добрый вечер всем
Появилась необходимость сделать на механизм защиту по контролю скорости задумка такая на валу барабана механизма стоит крыльчатка напротив неё закреплен индуктивный бесконтактный датчик типа ВБИ сенсор клепает этот датчик хочу подключить к МВ110-16ДН выглядеть это будет примерно так

далее программная суть после включения механизма запускаться программный таймер на включение его нужно все время забрасывать сигналом с датчика время срабатывания таймера это время оборота крыльчатки то есть время между сработками датчика если сигнал сброса не пришёл вовремя то срабатывает таймер и останавливает механизм с выдачей на выход аварии до сброса аварии механизм не запустить снова
я тут набросал кое что может кто подскажет как это до ума довести

FUNCTION_BLOCK EL
VAR_INPUT
	start: BOOL;
	stop: BOOL;
       alarm_RESET:BOOL;
	podpor:BOOL;
	sped_kontrol:BOOL;
END_VAR
VAR_OUTPUT
	lamp: BOOL;
	OUT_1: BOOL;
        alarm_out:BOOL;
END_VAR
VAR
	tim1:TON;(*таймер аварии по подпору продуктом*)
	tim2:TON;(*таймер аварии по контролю скорости*)
END_VAR
=============================================================

(*----------Кнопки старт стоп----------------------------------*)
IF start=TRUE THEN
OUT_1:=TRUE;
lamp:=TRUE;
END_IF

IF stop=TRUE THEN
OUT_1:=FALSE;
lamp:=FALSE;
END_IF
(*-----------Контроль перегруза продуктом------------------------------------*)
IF podpor=TRUE THEN
tim1(in:=podpor, pt:=t#3s);
alarm_out:=Tim1.Q;
ELSE
tim1(in:=FALSE, pt:=t#3s);
END_IF
(*--------------Контроль скорости механизма----------------------------------*)
IF sped_kontrol=TRUE THEN
tim2(in:=sped_kontrol, pt:=t#3s);
alarm_out:=Tim2.Q;
END_IF
(*---------------Сброс аварии (квитирование)------------------------------*)
IF alarm_RESET=TRUE THEN
alarm_out:=FALSE;
tim1(in:=FALSE, pt:=t#3s);
tim2(in:=FALSE, pt:=t#3s);
END_IF
(*-------------------Выключение механизма при аварии--------------------*)
IF alarm_out=TRUE THEN
OUT_1:=FALSE;
lamp:=FALSE;
END_IF
(*---------------------------------------------------------------------------*)