Fix ExecuteFrame problems with cache in pause mode
Add StopLucy method
Distance and time are maintain as a class atribute
Add populateJointHandleCache to force the joint handler cache mapping fill
Add setJointPositionNonBlock for non blocking set joint primitive
Add finishSimulation
Cleanup and adding joint normalization