function setup_zenoh() {
    source /opt/ros/jazzy/local_setup.bash
    export RMW_IMPLEMENTATION=rmw_zenoh_cpp
    echo "Setup RMW to rmw_zenoh_cpp"
}
function setup_zenoh_client() {
    local ip="${1:-192.168.11.1}"
    export ZENOH_CONFIG_OVERRIDE="mode=\"client\";connect/endpoints=[\"tcp/${ip}:7447\"]"
}

function setup_zenoh_peer() {
    local ip="${1:-192.168.11.1}"
    export ZENOH_CONFIG_OVERRIDE="connect/endpoints=[\"tcp/${ip}:7447\"]"
}

setup_zenoh