Incentivizing Local Controllability in Optimal Trajectory Planning | IEEE Conference Publication | IEEE Xplore