My intent here was for goal2D to always be a 2D real vector state. If I do

base::ScopedState<> goal2D(si)

wouldn't that actually create a Dubins state?