Efficient variable-length hanging tether parameterization for marsupial robot planning in 3D environments