Robust point-to-point trajectory planning for nonlinear underactuated systems: Theory and experimental assessment