Implemented angular cost#34

CihatAltiparmak wants to merge 1 commit intofeature/improve_how_to_work_trajectory_costs_outCihatAltiparmak/frenet_ilqr_controller:feature/improve_how_to_work_trajectory_costs_outfrom

feature/add_angular_costCihatAltiparmak/frenet_ilqr_controller:feature/add_angular_costCopy head branch name to clipboard