Add mux for two cmd_vel input topic