Touch probe on a 5 DoF robotic arm

Hi everybody,

I am using a touch probe on a 5 DoF robotic arm. I have problems with the command G38.3, I have written the code attached here and when I run it [the robot doesn't stop in case of contact as expected.



Any suggestions?

Please write me soon._

NOTE : I am using a trivial kimeatics so X,YZ,A,B are the joint angles

Yes, I have

Any suggesttions?

I check it and it is triggered, but when the code is run, if the probe is triggered, the robot doesn't stop moving as expected
It seems that g38. 3 doesn't work..
Do you think that the code is correct or maybe there are some mistakes?

It works, thank you!