Waypoints Updates

Signed-off-by: Salja <salja8840@gmail.com>