Sampling-Based Motion and Symbolic Action Planning with geometric and differential constraints