Set the stop signal to 0 when a new motion is started to avoid false cancelations.

Added a new variable to hold the angle required by the deacceleration phase with the initial command data, instead of computing it each cycle.
Changed the max force default value of the grippers.