Finish action only when the controller frame has arrived
Implement a check to see if the end effector has arrived. The following things should be taken into consideration:
- What if it arrives earlier? Is it reached or should it only check after
- How to combine this with overlay motions? The end-effector pose could be too far away
- Are accepted threshold set per motion or globally?
- Should there be a timeout?