The “Waterfilling Algorithm”—An Efficient Approach for Vehicle Velocity Planning With Varying Velocity Limits | IEEE Journals & Magazine | IEEE Xplore