请教立轴平面磨床的竖直间歇进给运动控制

自己试着做了一段程序，思路是这样的：

1）启动高速计数器子程序；
2）定时器T32定时触发中断事件21，实现间歇调用进给PTO子程序,进给PTO中设置进给速度和次磨削量；
3）每次进给完成，都将次磨削量进行累积；
4）高速计数子程序中设定总磨削量；
5）高速计数完成后，触发中断事件29，运行中断程序COUNT_EQ；
6）在中断程序COUNT_EQ中，分别将高速计数当前值与预设值清零，分别将进给PTO当前值与预设值清零，将当前还在运行的进给PTO复位，将反方向Q0.2置位，延时（光磨）到后，调用砂轮返升PTO子程序，砂轮返升。
7）在返升子程序中设定返升高度和返升速度 。

下面我再把程序传上来 ，大家帮我看看，提一下意见哈 ，这里谢啦！

下面是刚刚做的磨床程序，请大家多提意见

尽管发在这三伏天，还是感觉贴子有点冷！不过很体谅年中大家都很忙啊……

大家给个建议，这个分咋赏呢？

上两张磨床磨削时的照片