Fix for G61 Issue

Added an extra check to velocity optimization to make sure that requested velocity is respected. Also added an explicit exact stop mode (vs. exact path).

See thread here for details:

https://groups.google.com/forum/#!searchin/machinekit/discriminant/machinekit/u-Cni7u6jPQ/Da_qzl5AjAgJ

fixes #232