1. Initialize:

2. Time Delay

3. Sampling Time

4. number Of Points

5. l Time Delay/Sampling Time

6. frac_m % is m according expression (3)

7. frac_m l – Time Delay/Sampling Time

8. α e a × frac_m × SamplingTime

9. m [ 0 0 ]

10. For cont 1 to number Of Points – 1

11. k cont+1

12. e ( k ) 1 m ( k )

13. If k = 2 then

14. u [ k ] = k c 2 t i + T 2 t i e [ k ] % expression (10)

15. else

16. u [ k ] = u [ k 1 ] + k c 2 t i + T 2 t i e [ k ] + k c T 2 t i 2 t i e [ k 1 ] % expression (10)

17. End if

18. % expression (11)

19. If k = 2 then

20. y [ k ] = 0

21. Else if k 2 and k l

22. y [ k ] = e a T y [ k 1 ]

23. Else

24. y [ k ] = e a T y [ k 1 ] + 1 α a u [ k l 1 ] + α e a T a u [ k l ]

25. End if

26. % expression (12)

27. If k = 2 then

28. m [ k ] = 2 t d + T 2 t f + T y [ k ]

29. Else

30. m [ k ] = 2 t f T 2 t f + T m [ k 1 ] + 2 t d + T 2 t f + T y [ k ] + T 2 t d 2 t f + T y [ k 1 ]

31. End If

32. m [ k + 1 ] = m [ k ]

33. End For