Incentivizing Local Controllability in Optimal Trajectory Planning. - Antoni Z. Skoraczynski; Chris Manzie; Peter M. Dower (ACC, 2023)