nav2_constrained_smoother: Ceres cost function corrected#895

SteveMacenski merged 2 commits intoros-navigation:masterros-navigation/docs.nav2.org:masterfrom

videh25:videh_constrained_smoother_cost_improvementsvideh25/docs.nav2.org:videh_constrained_smoother_cost_improvementsCopy head branch name to clipboard