CODESYS V3.5. Визуализация

[firetester]

И снова здравствуйте! Все никак не получается совладать с графиком из PolyLine...

Код:

start_rs(set:=start, reset1:=stop);
takt(enable:=start_rs.Q1, timelow:=T#50MS, timehigh:=T#50MS);
takt_trig(clk:=takt.OUT);
//чтоб не выходил за границы
If temp_input<0 then
temp_input:=0;
ELSIF temp_input>160 THEN
temp_input:=160;
END_IF

//отрисовка
IF takt_trig.Q=TRUE AND PointsNum<=720 THEN
arrOfPoints[pointsNum].iX:= PointsNum+50;
arrOfPoints[pointsNum].iY:= REAL_TO_INT(450-(temp_input/0.4));
pointsNum:=pointsNum+1;
END_IF

//сдвиг
IF takt_trig.Q=TRUE AND PointsNum=721 THEN
FOR i:=0 TO 719 BY 1 DO
arrOfPoints[i].iX:=arrOfPoints[i+1].iX;
arrOfPoints[i].iY:=arrOfPoints[i+1].iY;
END_FOR
arrOfPoints[720].iX:= PointsNum+50;
arrOfPoints[720].iY:= REAL_TO_INT(450-(temp_input/0.4));

END_IF

Отрисовывает график нормально, а когда приходит пора его сдвигать, начинает "отщипывать" точки от начала... Никак не найду где ошибся. Подскажете?