I am using a CB3.
The force() checking should then be executed in a separate thread right? Because it is not possible to check the force while the robot moves from waypoint to waypoint. Then when checking the force in the thread and the force exceeds an X amount then I could force the robot to stop?!