Updates for robotActionController changes, change to eculidian distance calculation