More FM methods added

Could you please rename it to setInitialAndGoalPoints() please?