ADD: ATO decelerate when arriving stop, decelerate when near new lower speed flag

TODO: ATO smart hold brake w/out using HB

Signed-off-by: hkgsherlock <hkgsherlock@gmail.com>