via zeus defining waypoints for the ai is a very simple way (could also be done better, but thats not the point here), instead placing waypoints for autonomous units looks oldskool.
why not try to take over the zeus way of doing that.
plus
3d environment
better visual waypoints (please add a line from height to ground, so you can better see the
destination)
please add height and speed via keyboard input
thnx!