Safe and Online MPC for Managing Safety and Comfort of Autonomous Vehicles in Urban Environment | IEEE Conference Publication | IEEE Xplore