MATLAB path planning works! RPC calls replace pubsub throughout