определение направления движения механизма

[alexval2006]

Добрый день товарищи такая проблема начал осваивать плк100 и CoDeSys
пока что без плк в режиме эмуляции плк еще в пути
Значит к сути есть механизм который может двигаться вперед и назад по прямой по этой прямой есть 10 точек с датчиками положения механизма (концевики) если механизм находиться в данный момент на точке №4 а ему надо попасть на точку №10 как определить направление движения механизма вперед или назад. Я тут подумал что наверно можно сделать сравнение по номеру больше меньше типа что то такое (просьба не пинать я киповец а программирование только осваиваю )
если точка А это точка где находиться механизм(определяем по датчикам) в данный момент а точка Б это точка куда нужно попасть(выбираться кнопками) то из этого следует такое условие
Если А<Б то механизм движется в перед
Если А>Б то механизм движется назад
Помогите из этого сделать что то путное на ST.
Буду очень признателен за любую помощь ночевку

Добавлено позже

вот что я родил спустя несколько часов после чтения букваря по CoDeSys
А1-А10 положение механизма (сигнал с датчиков)
В1-В10 куда нужно переместить механизм (сигнал с кнопок)
С1-выход движения механизма вперед
С2- выход движения механизма назад
Из этого получаться вот такой код на ST

if B < A ТНЕN
C1:=TRUE;
elseif B > A ТНЕN
C2:=TRUE;
end_if

Это вроде правильно вот теперь как сделать чтобы сигнал с нужной кнопки и нужного датчика принимал числовое значение чтобы эти значения присвоить переменным А и В а потом сравнивать. Голова идет кругом от всей этой информации усвоенной за сегодня помогите плиз