Testing moveThetaPhi threshold value in a systematic manner

When moving a cobra to a target, threshold value defines the distance for switching between fast and slow motor map. This value was set to be 2mm which is ~0.5*patrol radius. We should test different values to check if there is any difference.