fix effort computation
fix effort computation

Yannick changed this value according to the dist_per_tick computation.
However, effort is fully independent here and is still scaled between
0 and 255.

TAMS-Group/robotiq_s_model_action_server,TAMS-Group/robotiq_s_model_action_server