Add Euclidean distance computation for Cartesian safe acceleration limits
Add Euclidean distance computation for Cartesian safe acceleration limits

frankaemika/libfranka,frankaemika/libfranka,frankaemika/libfranka