Adjust critical sections
Adjust critical sections

Optimised the used of the the enter_critical and exit_critical sections

UniversalRobots/Universal_Robots_Client_Library,UniversalRobots/Universal_Robots_Client_Library