Using stoppable thread in the primitives
Correct a bug in the primitive.
Merge branch 'vrep' into refactor-controller