[z1820] Rewrite WaypointMovementGenerator

(based on commit e4bbc3d)

Signed-off-by: stfx <stfx@hotmail.de>

(cleaned version of f2713c9)

(based on commit [s1378] - 1f2c242)