add solve function to "include/dubins_solver.hpp"