Post a sample of code that you require, showing the beginning, a little of the movement and the end. Also, do you have a tool changer?
I can't guarantee I'll get to it soon as I'm extremely busy, but with samples posted others can easily help you as well.
Dan